Platooning control via accurate synchronization

ABSTRACT

Various embodiments provide for platooning control via accurate synchronization that will not result in string instability. Some embodiments provide a distributed control scheme for platoon motion control that provides a decentralized implementation of the leader information controller. These control techniques are able to manage the performance of the string of vehicles by maintaining a desired spacing distance between any two successive vehicles in the presence of communications induced delays. In order to regulate the spacing between a vehicle and its predecessor in the string, every vehicle (with the exception of the leader vehicle) uses the relative distance from itself to its predecessor (e.g., as measured using a laser ranging sensor) and a control signal of the predecessor (e.g., received via a wireless link). Various embodiments are capable of dealing with non-homogeneous strings of vehicles and non identical controllers for each vehicle in the string.

CROSS REFERENCE TO RELATED APPLICATIONS

This application is a continuation of U.S. application Ser. No. 15/494,322 filed Apr. 21, 2017. The Ser. No. 15/494,322 is a continuation of PCT/US2015/056741 which in turn claims priority from U.S. Provisional Patent Application No. 62/066,703 filed on Oct. 21, 2014, U.S. Provisional Patent Application No. 62/068,319 filed Oct. 24, 2014, U.S. Provisional Patent Application No. 62/075,656 filed Nov. 5, 2014 and U.S. Provisional Patent Application No. 62/145,591 filed Apr. 10, 2015, the contents of all of which are hereby incorporated by reference herein in their entireties for all purposes.

TECHNICAL FIELD

Various embodiments of the present technology generally relate to automated control of platooning vehicles. More specifically, some embodiments relate to a mechanism for platooning control via accurate synchronization.

BACKGROUND

Technological advances in various disciplines such as computer vision, ranging sensors, wireless communications and estimation and detection algorithms have made autonomous vehicles a reality. From automated flying drones to automobiles, these vehicles have the ability to make decisions and perform almost any maneuver without any human assistance. Such maneuvering can be safely performed, for example, on public roadways with traffic present and includes emergency stopping, steering and turning, navigating, lateral and garage parking. Sensor data and other information is collected and processed in order to facilitate lane keeping, traffic signs recognition and awareness, object tracking in vehicle's operating range (pedestrians or other vehicles), etc. and then used to determine accordingly the vehicle's desired trajectory.

However, there are still many operations of autonomous vehicles which are difficult to perform in an automated fashion. For example, platoon motion control has been a problem of interest for the control engineering community for about fifty years and still persists. The platoon motion control problem is easy to solve (using standard design methods) provided that each vehicle in the platoon has instant access at all times at the relative coordinates and at the instantaneous speed of all other vehicles. Even with today's ubiquitous communication technology this is not a realistic scenario.

As a result, the control engineering community has considered of interest those decentralized control schemes which use information that can be measured with sensors placed on-board each vehicle, specifically the relative distance from each vehicle to its predecessor in the platoon. This is typically a distance ranging between 20 and 250 yards, which can be measured using a low cost but highly reliable optic (lidar) or radar (electromagnetic) ranging sensor mounted on each vehicle. However, a difficulty dubbed “string instability” has been documented for control schemes with long strings of vehicles that use only local information.

Intuitively “string instability” can be described as the phenomenon of amplification of a disturbance to the leader vehicle, as the disturbance propagates toward the back of the platoon. “String instability” is obviously undesirable, since it can ultimately lead to vehicles in the string crashing into each other. Equally important, lack of a strong attenuation of a disturbance to any car in the string propagating towards the back the string (i.e., a high “sensitivity to disturbances”), even if it does not necessarily lead to instability, it produces another highly unwanted effect: the so-called accordion effect. The accordion effect greatly disrupts the throughput of the highway traffic.

As such, there are a number of challenges and inefficiencies created in traditional automated platooning vehicle design which need to be addressed. Given the technological platforms described above that are already available to the automobile industry, it would be useful to design and implement a feasible control scheme along with suitable control algorithms, in order to tackle the undesired and potentially risky oscillatory phenomena inherent to the dynamics of vehicle platooning (the so-called Forrester effect, or bullwhip effect) while maximizing the throughput of highway traffic by reducing the accordion effect on the behavior of the platoon. It is with respect to these and other problems that embodiments of the present invention have been made.

SUMMARY

Various embodiments of the present technology generally relate to automated control of platooning vehicles (e.g., automobiles, trains, submersible vessels, drones, and other types of mobile agents). More specifically, some embodiments relate to a mechanism for platooning control via accurate synchronization.

In some embodiments, a method for operating a vehicle within a string of platooning vehicles includes receiving, via a wireless communications link (e.g., an optical link or a personal area network), a control signal of a predecessor vehicle. The platoon may be heterogeneous (i.e., have at least two different vehicle types) or homogenous (i.e., all similar vehicle types). The predecessor vehicle immediately precedes the vehicle in the string of platooning vehicles.

Each vehicle in the string of platooning vehicles may have access to a synchronized clock. The control signal from the predecessor vehicle may have been stamped with a first time base from the synchronized clock (e.g., from a global positioning system). The method can also include determining a distance (e.g., using lidar or radar) between the vehicle and the predecessor vehicle which can be stamped or associated with a second time base from the synchronized clock. The distance and control signal can then be synchronized based on first time stamp and the second time stamp.

A control action to maintain a desired distance between the vehicle and the predecessor vehicle can be generated based at least in part on the synchronized distance and control signal. The desired distance may be constant or vary based on a variety of factors such as the current weather or road conditions. In some embodiments, the desired distance between the vehicle and the predecessor vehicle is proportional to a speed of the vehicle.

In some embodiments, a vehicle may include a throttling and braking system, a communications system, a distance measuring system, a synchronization module, and/or a controller. The throttling and braking system may be capable of accelerating or decelerating the vehicle. The communications system may include a receiver to receive communications from a predecessor vehicle and a transmitter to transmit signals to a follower vehicle. The communications system may use a variety of technologies such as, but not limited to personal area network technology, cellular technology, or optical technology for transmitting signals. The communications from the predecessor vehicle may include control signals and/or other information (e.g., vehicle identifiers, vehicle type, acceleration, and the like) from the predecessor vehicle. The controls signals and/or other information may be labeled with time stamps indicating the time of execution and/or transmission.

The distance measuring system may repeatedly measure distances between the vehicle and the predecessor vehicle over time. In some embodiments, the distance measuring system may include lidar, radar, and/or other systems capable of measuring distance. The distances measured by the distance measuring system may be stored (e.g., within a local memory) with time stamps indicating the time of measurement. The synchronization module can synchronize the distances measured by the distance measuring system and the control signals and/or other information based using the time stamps. The controller can generate a control action to be implemented by the throttling and braking system to maintain a desired distance behind the predecessor vehicle. The desired distance may be constant or dynamic (e.g., proportional to a speed of the vehicle). The control action may be based, at least in part, on the control signals and distances synchronized by the synchronization module.

The vehicle may also include a global positioning system and/or a memory having stored thereon model dynamics for one or more vehicles. In some embodiments, the controller may retrieve, from the memory, a dynamical model of the predecessor vehicle, use the dynamical model in the generation of the control action. Instead of having locally stored dynamical models, some embodiments may retrieve the model dynamics from remote storage (e.g., using a wireless network to access a cloud-based server.)

Embodiments of the present invention may also include computer-readable storage media containing sets of instructions to cause one or more processors to perform the methods, variations of the methods, and other operations described herein.

While multiple embodiments are disclosed, still other embodiments of the present invention will become apparent to those skilled in the art from the following detailed description, which shows and describes illustrative embodiments of the invention. As will be realized, the invention is capable of modifications in various aspects, all without departing from the scope of the present invention. Accordingly, the drawings and detailed description are to be regarded as illustrative in nature and not restrictive.

BRIEF DESCRIPTION OF THE DRAWINGS

Embodiments of the present technology will be described and explained through the use of the accompanying drawings in which:

FIG. 1 illustrates a group of platooning vehicles in accordance with some embodiments of the present technology;

FIG. 2 illustrates an example of a set of components which may be present in a vehicle utilizing one or more embodiments of the present technology;

FIG. 3 illustrates an example of a set of components in a synchronization based control mechanism according to various embodiments of the present technology;

FIG. 4 is a flowchart illustrating an example of a set of operations for controlling a vehicle according to some embodiments of the present technology;

FIG. 5 is a flowchart illustrating an example of a set of operations for operating a platooning vehicle that may leave the platoon in accordance with one or more embodiments of the present technology;

FIG. 6 a flowchart illustrating an example of a set of operations for operating a platooning vehicle whose predecessor vehicle may leave the platoon formation according to one or more embodiments of the present technology;

FIG. 7 is a block diagram illustrating a unity feedback loop of a plant G with a controller K;

FIG. 8 is a block diagram illustrating an example of a leader information control for the first three vehicles in the string, in accordance with some embodiments of the present technology;

FIG. 9 is a block diagram illustrating an example of a leader information control in accordance with some embodiments of the present technology;

FIG. 10 is a block diagram illustrating an example of an implementation with the constant time-headway H for the first three vehicles in the string that can be used in various embodiments of the present technology;

FIG. 11 is a block diagram illustrating an example of an implementation with the constant time-headway H that can be used in one or more embodiments of the present technology;

FIG. 12 is a block diagram illustrating an example of a leader information control with time delays compensation that can be used in some embodiments of the present technology;

FIG. 13 is a block diagram illustrating an example of a leader information control equivalent scheme where the time delays have been included in the dynamical model of the plant, that can be used in various embodiments of the present technology; and

FIG. 14 illustrates simulation results for distributed leader information control for platooning.

The drawings have not necessarily been drawn to scale. Similarly, some components and/or operations may be separated into different blocks or combined into a single block for the purposes of discussion of some of the embodiments of the present technology. Moreover, while the technology is amenable to various modifications and alternative forms, specific embodiments have been shown by way of example in the drawings and are described in detail below. The intention, however, is not to limit the technology to the particular embodiments described. On the contrary, the technology is intended to cover all modifications, equivalents, and alternatives falling within the scope of the technology as defined by the appended claims.

DETAILED DESCRIPTION

Various embodiments of the present technology generally relate to automated control of platooning vehicles (e.g., drones, trains, submersible vessels, mobile agents, and the like). More specifically, some embodiments relate to a mechanism for platooning control via accurate synchronization. Formation control for platooning of autonomous vehicles has been a longstanding problem in control theory. The automated control system's objective in the platooning problem is to regulate the inter-vehicle spacing distances (e.g., to pre-specified values) in the presence of disturbances caused by the real life road and traffic conditions. The problem could be completely solved within the classical control framework, under the assumption that each vehicle has access, in real time, to an accurate measurement of its relative positions with respect to all its predecessors in the string (centralized control). It became clear from the very beginning that this scenario is infeasible from several engineering practice standpoints.

Traditional predecessor follower control strategies where each vehicle has access to only local measurements of instantaneous distance with respect to the vehicle in front of the current vehicle (e.g., measured using onboard sensors) have a number of problems that can arise. For example, although (under the common assumption of linear dynamics for each vehicle) the internal stability of the aggregated platoon can be achieved, this basic architecture was proved to exhibit a severe drawback known as “string instability”. While several formal definitions of string instability exist, they essentially describe the phenomenon of amplification downstream the platoon of the response to a disturbance at a single vehicle. Correspondingly, the configurations designated as “string stable” are those feedback configurations for which the H, norm of the transfer function from the disturbances at any given vehicle to any point in the aggregated closed-loop of the platoon, does not formally depend on the number of vehicles in the string.

If the vehicles dynamics contain a double integrator, then for predecessor follower schemes of homogeneous platoons with identical sub-controllers, string instability will occur irrespective of the chosen linear control law, as it is an effect of fundamental limitations of the feedback-loop. This shortcoming cannot be overcome by adding the relative distances with respect to multiple preceding vehicles to the measurements available to each sub-controller (multiple look-ahead schemes), nor can it be overcome by including the successor's relative position (bi-directional control), without exacerbating the so-called accordion effect (or settling time). Other solutions, including optimal control approaches and the sharing of additional information (e.g., acceleration), fail to resolve this issue.

In contrast, various embodiments of the present technology provide a mechanism for platooning control via accurate synchronization that will not result in the string instability of traditional approaches. For example, some embodiments provide control techniques for effectively controlling an array of n autonomous, self-driving vehicles moving in one dimension, all traveling in the same (positive) direction of a highway with a single line of traffic. These control techniques are able to manage the performance of the string of vehicles by maintaining a pre-specified spacing distance between any two successive vehicles, whilst maintaining the velocity imposed by the leader vehicle (first car in the string).

Some embodiments of the present technology, in order to regulate the spacing between itself and its predecessor in the string, every vehicle (with the exception of the leader vehicle) uses two pieces of information from its predecessor. Firstly, the relative distance from itself to its predecessor, which can be measured using an on-board laser ranging sensor and secondly, a low data rate, digital radio signal sent from its predecessor. The wireless signal may include the predecessor's control signal if the current vehicle knows, or is able to identify, the dynamical model of the predecessor vehicle. Various embodiments are capable of dealing with non-homogeneous strings of vehicles and with the case of having non identical controllers for each vehicle in the string.

As described in more detail below, some embodiments use the Youla parameterization of all leader information controllers associated with a given platoon of vehicles, by imposing a particular sparsity constraint on the Youla parameter. This parameterization can be based on a doubly coprime factorization of the aggregated model of the platoon that features a special structure. The sparsity constraint imposed on the Youla parameter preserves the structure of the doubly coprime factorizations and consequently the structure of the resulted stabilizing controllers. The tuning of the local controllers can be done by choosing H² or a H^(∞) (or mixed) cost functionals, represents the usual metrics in control theory to evaluate reliability and performance. The Youla parameterization of various embodiments can be amenable to incorporating such costs in the controller design method.

In some embodiments, the control signal of the predecessor vehicle can be broadcast to the subsequent (or follower) vehicle instead of a local estimate of the leader's state. The control signal is basically generated on board of the predecessor vehicle, hence there is no need to estimate it. The fact that information free of noise is broadcasted (with some time-delay induced by the wireless communication systems) has profound implications in terms of the performance of the closed loop. In some embodiments, the acceleration of the predecessor vehicle can be broadcast to the subsequent (or follower) vehicle. This can be a useful alternative, for example, when the dynamical model of the predecessor vehicle is unknown. In addition to existing Cooperative Adaptive Cruise Control Methods, the leader information control scheme introduced here can be adapted as to compensate for the feedforward time-delay induced by the wireless transmission of the predecessor's control signal, as will be explained in more detail below. The synchronization of the onboard measurements with the wirelessly received data may induce fixed, commensurate and point-wise time delays in the control mechanism thus avoiding the difficulties caused by time-varying or stochastic or distributed time delays.

Various embodiments of the present technology describe a distributed control architecture for platooning control of (semi)autonomous vehicles. The distributed implementation used in some embodiments allows for the controller on board each vehicle to use only locally available information. Some embodiments improve on existing methods in the following aspects:

-   -   guarantees string stability in the presence of time delays         induced by the wireless communications;     -   eliminates the accordion effect from the behavior of the         platoon;     -   achieves string stability, even for constant or distance         headways inter-spacing policies;     -   the synchronization of the onboard measurements with the         wirelessly received data induces fixed, commensurate and         point-wise time delays in the control mechanism thus avoiding         the difficulties caused by time-varying or stochastic or         distributed time delays;     -   is amenable to optimal controller design via norm based costs,         while accommodating heterogeneous strings of vehicles and         heterogeneous controllers.

In the following description, for the purposes of explanation, numerous specific details are set forth in order to provide a thorough understanding of embodiments of the present technology. It will be apparent, however, to one skilled in the art that embodiments of the present technology may be practiced without some of these specific details. While, for convenience, embodiments of the present technology are described with reference to platooning of autonomous cars by generating a unique control scheme via synchronization, embodiments of the present technology are equally applicable to various other types of vehicles (e.g., drones, trains, submersible vessels, mobile agents and the like) as well as other applications where interspacing distance needs to controlled (e.g., in manufacturing applications).

The techniques introduced here can be embodied as special-purpose hardware (e.g., circuitry), as programmable circuitry appropriately programmed with software and/or firmware, or as a combination of special-purpose and programmable circuitry. Hence, embodiments may include a machine-readable medium having stored thereon instructions which may be used to program a computer (or other electronic devices) to perform a process. The machine-readable medium may include, but is not limited to, floppy diskettes, optical disks, compact disc read-only memories (CD-ROMs), magneto-optical disks, ROMs, random access memories (RAMs), erasable programmable read-only memories (EPROMs), electrically erasable programmable read-only memories (EEPROMs), magnetic or optical cards, flash memory, or other type of media/machine-readable medium suitable for storing electronic instructions.

FIG. 1 illustrates a group of platooning vehicles 110A-110D in accordance with some embodiments of the present technology. While FIG. 1 only shows four vehicles, vehicles 110A-110D may be part of a larger platoon with more vehicles than illustrated in FIG. 1. Vehicle 110A is the lead vehicle which is in front of all of the subsequent (or follower) vehicles 110B-110D drafting one behind the other. A controller can be used to maintain the desired interspacing distances 120A-120C. These distances may be fixed or may change depending on various conditions (e.g., weather conditions, communication quality, weight of the vehicle, vehicle dynamics, braking abilities, and the like). For example, interspacing distances 120A-120C may increase when the roads are wet or snowy.

FIG. 2 illustrates an example of a set of components which may be present in vehicle 110A-110D in one or more embodiments of the present technology. As shown in FIG. 2 vehicle 110A-110D may include power supply 205 (e.g., battery), memory 210 (e.g., volatile memory and/or nonvolatile memory), processor(s) 215 for executing instructions and performing calculations, sensors 220, communication system 225, controller 230, and global positioning system (GPS) 235. Other embodiments of the present technology may include some, all, or none of these modules and components along with other modules, applications, and/or components. Still yet, some embodiments may incorporate two or more of these modules and components into a single module and/or associate a portion of the functionality of one or more of these modules with a different module.

Memory 210 can be any device, mechanism, or populated data structure used for storing information. In accordance with some embodiments of the present technology, memory 210 can encompass any type of, but is not limited to, volatile memory, nonvolatile memory and dynamic memory. For example, memory 210 can be random access memory, memory storage devices, optical memory devices, media magnetic media, floppy disks, magnetic tapes, hard drives, SDRAM, RDRAM, DDR RAM, erasable programmable read-only memories (EPROMs), electrically erasable programmable read-only memories (EEPROMs), compact disks, DVDs, and/or the like. In accordance with some embodiments, memory 210 may include one or more disk drives, flash drives, one or more databases, one or more tables, one or more files, local cache memories, processor cache memories, relational databases, flat databases, and/or the like. In addition, those of ordinary skill in the art will appreciate many additional devices and techniques for storing information which can be used as memory 210.

Memory 210 may be used to store instructions for running one or more applications or modules on processor(s) 215. For example, memory 210 could be used in one or more embodiments to house all or some of the instructions needed to execute the functionality of or manage sensors 220, communication system 225, controller 230, and/or GPS 235. Processor(s) 215 are the main processors of vehicle 110A-110D which may include application processors, various coprocessors, and other dedicated processors for operating vehicle 110A-110D. Processor(s) 215 may be communicably coupled with memory 210 and configured to run the operating system, user interfaces, sensors 220, communication system 225, controller 230, GPS 235, and/or other components.

In some embodiments, processor(s) 215 may include multiple dedicated or shared processors configured to perform signal processing, implement/manage real-time radio transmission operations, or make navigation decisions (e.g., compute trajectories, implement obstacle avoidance routines, etc.). These processors along with the other components may be powered by power supply 205. The volatile and nonvolatile memories found in various embodiments may include storage media for storing information such as processor-readable instructions, data structures, program modules, models, or other data. Some examples of information that may be stored include basic input/output systems (BIOS), operating systems, and applications.

Sensors 220 may be used to detect events or changes in the surrounding environment and produce a corresponding signal that can be acted upon by various components within the vehicle or transmitted to other vehicles within the platoon or global monitoring infrastructure. In some embodiments, sensors 220 may include one or more of the following: accelerometers, camera, infrared sensors, ranging sensors, motion sensors, LIDAR, RADAR, gyroscopes, and the like. For example, a ranging sensor can be used to measure the distance to the predecessor vehicle. In some embodiments, optical ranging devices such as Hilti PD-40/PD-42 or the Leica Disto Series (D2, D5, D8) could be used. The optical ranging devices may be associated with optical target plates mounted on the back of each vehicle in order to improve ranging performance. The optical ranging devices may include an aiming system using, e.g. gyroscopic systems, computer vision or other technologies. In some embodiments, a radar ranging device (electromagnetic waves) may be used. Alternatively, sonar or other acoustic ranging devices may be used in some embodiments as they may be more applicable for certain environments (e.g. underwater vehicles).

Communication system 225 may include a local wireless communication link with neighboring vehicles, along with (GPS Synchronized) Precision Time Protocol supported by GPS 235. In accordance with various embodiments, the communication system may use a digital radio, such as Wifi, Bluetooth or ZigBee could be used, with or without enhancing the standard transmission power PTP/IEEE-1588. Other embodiments may use analog radio options enabling, for example, software radio implementations. Optical or acoustic (e.g. sonar) communication links may be preferable for underwater vehicles. Controller 230 can take various inputs and produce a control signal to regulate the interspacing distance.

While not illustrated in FIG. 2, each vehicle may include an electrohydraulic braking and throttle actuation system with calibrated control signal. For example, in some embodiments, the electrohydraulic braking systems may include a BRAKEMATIC produced by EMG Automation GmbH. In addition, various embodiments may have throttle control systems used in common cruise control systems may be used. An interface to electronic braking systems, such as those produced by TRW Automotive or the MOVE gateway produced by TNO can be used in some embodiments.

An onboard computer may be used in some embodiments. For example, a Field Programmable Gate Array (FPGS) such as the Xilinx Zynq-7000 All Programmable System on a Chip may be used in some embodiments. Alternatively, various schemes for embedded processing can be used, such as ABBs System 800xA or the AC 800M processor module 3. A dSpace Autobox system can be used in one or more embodiments. For testing purposes, alternatively, the system can be enabled using even standard computing technologies, such as a laptop or other personal computer, that has the needed data interfaces (acquisition and transmission) and a software platform such as MATLAB.

FIG. 3 illustrates an example of a set of components in a synchronization based control mechanism according to various embodiments of the present technology. As illustrated in FIG. 3, the set of components can include data receiver 305, radar/lidar system 310, GPS 315, synchronization module 320, digital controller 325, dynamical models 330, vehicular data 335, speedometer 340 and data transmitter 345. Other embodiments may include only some of these components or may include additional component not illustrated in FIG. 3.

While not performing merging/exiting maneuvering and while functioning in the semi-autonomous mode, the vehicle must maintain a wireless data link in order to receive real-time data from its predecessor in the string. In some embodiments, the received data may include: the numerical code identifying the dynamical model of the predecessor; and the nominal value of the time delay incurred at the predecessor's transmission of data; the control signal u_(k−1) produced on board of the predecessor. The wireless data link can be implemented using digital radio communications such as WiFi, Zigbee, Bluetooth or other personal area network protocols. These types of personal area networks may have a limited range (e.g., less than 100 meters). The predecessor vehicle may use its own GPS timebase clock (with a very high clock update rate) for transmitting its control signal, using a time stamping protocol or something similar or equivalent.

In some embodiments, the current vehicle can also maintain a wireless data transmitter link 345 for sending to the follower in the convoy data comprising of: the numerical code identifying its own dynamical model; the nominal value of the time delay incurred at the wireless transmission of data; and the control signal u_(k) produced by its onboard controller.

The control mechanism illustrated in FIG. 3 can use: data acquired using its onboard radar/lidar sensor 310 for measuring the interspacing distance/relative speed z_(k) with respect to its predecessor in the string; data received wirelessly via data receiver 305 from its predecessor in the string. The onboard measurement signal z_(k) is time stamped using the onboard GPS timebase. The predecessor's control signal u_(k−1) is received on board the vehicle with a communications induced delay. Synchronization module 320 on board the vehicle can accurately identify this delay using the vehicle's local GPS timebase set by GPS clock 315 and the time stamping protocol used at the transmission of u_(k−1).

Synchronization module 320 uses the identified value of the communications delay in order to synchronize the predecessor's control signal u_(k−1) with the on board measurement z_(k). Specifically, each sample of the on board measured signal z_(k) can be delayed with the identified transmission delay of the sample of u_(k−1) produced at the same time moment. The two synchronized signals ũ_(k−1) and {tilde over (z)}_(k) represent input signals for digital controller 325. The numerical code identifying the predecessor's dynamical model 330 can be used in conjunction with an onboard RAM device containing a data base with existing dynamical models in use by other vehicles equipped with the current technology.

In certain embodiments dealing with heterogeneous string of vehicles, the synchronization mechanism described here can be used to introduce certain supplemental time delays in the control scheme. The specific values of such supplemental time delays for each vehicle may be chosen as a function of the vehicle's latency, where the vehicle's latency is defined here to be the sum of the nominal (or worst case scenario) value of the time delay of the vehicle's electro-hydraulic brake and throttle actuating system with the nominal (or worst case scenario) value of the time delay incurred at the wireless transmission of data. The specific value of such a supplemental delay may be negotiated between the vehicles in formation (through communications protocols) and may be chosen to be equal to the maximum of the latencies of all vehicles in the string.

The predecessor's dynamical model 330 can be used as a functioning parameter for onboard digital controller 325. Information about the vehicle's operating mass is used as to set up the vehicle's dynamical model (and the corresponding numerical code identifying it) and as a functioning parameter of digital controller 325. A data validity link signal may be used as a functioning parameter of digital controller 325, confirming that the receiving of data from the predecessor is not disrupted. Any disruption in the receiving of data from the predecessor is signaled to digital controller 325 such that it can apply the brakes and reduce speed or switch to a control policy based exclusively on the onboard measurements z_(k). A performant speedometer 340 on board the vehicle can provide the instantaneous speed of the vehicle as a functioning parameter for digital controller 340 in order to implement time-headways interspacing policies, which represent standard requirements for autonomous road vehicles.

Digital controller 340 in some embodiments can include a real-time computer platform that executes the synchronization based control mechanism's functionality, in order to produce the command signal representing the inputs of an electro-hydraulic brake and throttle actuating system (not shown). Throttle and brake valve position sensors may be used. The electro-hydraulic brake and throttle actuating system can be used in conjunction with existing mechanisms for electronic throttle control and electro-hydraulic brake valves and with existing automotive drive trains and can also serve the purpose of acquiring the desired dynamical model for the longitudinal dynamics of the vehicle. An additional interface such as MOVE gateway produced by TNO can be used in some embodiments to convert the acceleration setpoints u_(k) into vehicle electro-hydraulic break and throttle actuating setpoints.

The dynamical model of the vehicle can be determined using existing model identification and model validation techniques by measuring the acceleration response of the vehicle to certain test signals. The operating mass (depending on the load) of the vehicle represents a parameter for its dynamical model. For each dynamical model, a unique numerical identifying code is assigned. A memory device storing the database comprising of all dynamical models along with their corresponding numerical identifiers for all vehicles using this technology is available onboard of each vehicle. More specific details of various embodiments of controllers that can be used in the platooning vehicles are described below.

FIG. 4 is a flowchart illustrating an example of a set of operations 400 for controlling a vehicle according to some embodiments of the present technology. As illustrated in FIG. 4, measurement operation 410 measures the interspacing distance and the relative speed between the current vehicle and the predecessor vehicle. During stamping operation 420, the measurements are time stamped (e.g., with a GPS timebase). Receiving operation 430 receives the predecessor vehicle control signal which has been time stamped at the predecessor vehicle.

Identification operation 440 identifies the communications delay of the received control signal. Using this information, synchronization operation 450 synchronizes the control signal of the predecessor and the interspacing and relative speed measurements. The synchronization of the onboard measurements with the wirelessly received data can induce fixed, commensurate and point-wise time delays in the control mechanism during generating operation 460 and thus avoid the difficulties caused by time-varying or stochastic or distributed time delays.

FIG. 5 is a flowchart illustrating an example of a set of operations 500 for operating a platooning vehicle that may leave the platoon in accordance with one or more embodiments of the present technology. As illustrated in FIG. 5, monitoring operation 510 monitors the interspacing distance with the predecessor vehicle (i.e., the vehicle immediately in front of the current vehicle) in the platoon. Generation operation 520 generates a control action to maintain the desired interspacing distance. In accordance with various embodiments, generation operation 520 can be based, at least in part, on the interspacing distance and the control signal from the predecessor vehicle.

Monitoring operation 530 monitors for an indication that the vehicle is leaving the platoon. This indication may be triggered manually or automatically. For example, a drive may press a button or provide another indication (e.g., voice command) that the vehicle should leave the platoon. As another example, the indication may be trigger from a fault tolerant detection system that indicates there are one or more potential problems with the vehicle (e.g., communication failure, braking issue, throttling problem, etc.). If monitoring operation 530 determines that the vehicle should not leave the platoon, then monitoring operation 530 branches to monitoring operation 510 where the interspacing distance is monitored. If monitoring operation 530 determines that the vehicle should leave the platoon, then monitoring operation 530 branches to generation operation 540 where a control action is generated to leave the platoon (e.g., a lane change). During notification operation 550, the successor vehicle is notified of the predecessor's control information. Once the vehicle has left the platoon, the only needed reconfiguration is at the successor vehicle, who must acknowledge the numerical identifying code of the vehicle in front of it, which may serve as a parameter for its on board controller and receive the transmitted control signal of the vehicle in front of it. The control mechanism described in some embodiments will automatically regulate the interspacing error between the successor and the vehicle in front of it, which in some embodiments may be viewed as an impulse disturbance signal.

In some embodiments which will be described in detail, a (semi)autonomous vehicle equipped with the current technology may choose as a predecessor, a vehicle whose control signal is not automatically generated (e.g. a vehicle manually operated by a human) or choose as a predecessor a vehicle that is not equipped with the current technology and therefore does not transmit its control signal. Such a predecessor vehicle will therefore become the leader vehicle of the platoon formation.

FIG. 6 a flowchart illustrating an example of a set of operations 600 for operating a platooning vehicle whose predecessor vehicle may leave the platoon formation according to one or more embodiments of the present technology. As illustrated in FIG. 6, monitoring operation 610 monitors the interspacing distance with the predecessor vehicle (i.e., the vehicle immediately in front of the current vehicle) in the platoon. Generation operation 620 generates a control action to maintain the desired interspacing distance. In accordance with various embodiments, generation operation 620 can be based, at least in part, on the interspacing distance and the control signal from the predecessor vehicle.

Monitoring operation 630 monitors for an indication that the predecessor vehicle is leaving the platoon. This indication may be a signal from the predecessor vehicle. If monitoring operation 630 determines that the predecessor vehicle has not leave the platoon, then monitoring operation 630 branches to monitoring operation 610 where the interspacing distance is monitored. If monitoring operation 630 determines that the vehicle should leave the platoon, then monitoring operation 630 branches to operation 640 which acknowledges the numerical identifying code of the new predecessor vehicle (numerical code which may serve as a parameter for its on board controller) and receive the transmitted control signal of the new predecessor vehicle. The control mechanism described in some embodiments will automatically regulate the interspacing error between the vehicle and its predecessor vehicle, which in some embodiments described later in detail, may be viewed as an impulse disturbance signal.

As a result of a predecessor vehicle leaving the platoon formation, the vehicle might become the leader vehicle (the first vehicle) of the platoon. In such a situation, an indication may be issued to the driver who might take full manual control of the vehicle.

Most of the notation used hereinafter is quite standard in the systems and control literature. The Laplace transform complex variable is s∈£ and the Laplace transform of the real signal u(t) will be typically denoted with u(s) and can be distinguished by the change in the argument. When the time argument·(t) or the frequency argument·(s) can be inferred from the context or is irrelevant, it is omitted.

Table I contains notation for certain structured matrices which will be used. Assume the following notation:

TABLE I NOTATION FOR STRUCTURED MATRICES D {d₁, d₂, K, d_(n)} $\quad\begin{bmatrix} d_{1} & 0 & 0 & K & 0 \\ 0 & d_{2} & 0 & K & 0 \\ 0 & 0 & d_{3} & K & 0 \\ M & M & M & O & M \\ 0 & 0 & 0 & K & d_{n} \end{bmatrix}$ T {t₁, t₂, K, t_(n)} $\quad\begin{bmatrix} t_{1} & 0 & 0 & K & 0 & 0 \\ t_{2} & t_{1} & 0 & K & 0 & 0 \\ t_{3} & t_{2} & t_{1} & K & 0 & 0 \\ M & M & M & O & M & M \\ t_{n - 1} & t_{n - 2} & t_{n - 3} & K & t_{1} & 0 \\ t_{n} & t_{n - 1} & t_{n - 2} & K & t_{2} & t_{1} \end{bmatrix}$ R {r₁, r₂, K, r_(n)} $\quad\begin{bmatrix} r_{1} & 0 & 0 & K & 0 \\ r_{2} & r_{2} & 0 & K & \; \\ r_{3} & r_{3} & r_{3} & K & 0 \\ M & M & M & K & M \\ r_{n} & r_{n} & r_{n} & K & r_{n} \end{bmatrix}$

-   x     y x is by definition equal to y -   R(s) Set of all real-rational transfer functions. -   R(s)^(p×q) Set of p×q matrices having all entries in R(s) -   LTI Linear and Time Invariant -   TFM Transfer Function Matrix -   Q_(ij) The i-th row, j-th column entry of Q∈R(s)^(p×q) -   P★u(t) The time response with zero initial conditions of an (LTI)     system with TFM P and input u(t) -   The i-th row, j-th column entry of the TFM T_(zw)∈i (s)^(p×q),     mapping input vector w to output vector z

FIG. 7 illustrates the standard unity feedback configuration where G is a multivariable (strictly proper) LTI plant and K is an LTI controller. Here, w and v are the input disturbance and sensor noise, respectively, and u and z are the controls and measurements vectors, respectively. The T superscript denotes matrix transposition.

Denote by

$\begin{matrix} {{H\left( {G,K} \right)} = {\begin{bmatrix} T_{zw} & T_{zv} \\ T_{uw} & T_{uv} \end{bmatrix}\overset{def}{=}\begin{bmatrix} {{- \left( {I + {GK}} \right)^{- 1}}G} & \left( {I + {GK}} \right)^{- 1} \\ {{K\left( {I + {KG}} \right)}^{- 1}G} & {K\left( {I + {GK}} \right)}^{- 1} \end{bmatrix}}} & (1) \end{matrix}$

the closed-loop TFM of FIG. 7 from the exogenous signals [w^(T) v^(T)]^(T) to [z^(T) u^(T)]^(T). A certain TFM is stable if it has all its poles in the open left complex half-plane, and unimodular if it is square, proper, stable and has a stable inverse. If H(G,K) is stable then K is a stabilizing controller of G, or equivalently that K stabilizes G.

Given a square plant G∈i (s)^(n×n), a right coprime factorization of G is a fractional representation of the form G=NM⁻¹ with both factors N,M∈i (s)^(n×n) being stable and for which there exist X,Y∈i (s)^(n×n) also stable, satisfying YM+XN=I_(n), with I_(n), being the identity matrix. Analogously, a left coprime factorization of G is defined by G=M^(%−1)N^(%), with N^(%),M^(%)∈i(s)^(n×n) both stable and satisfying M^(%)Y^(%)+N^(%)X^(%)=I_(n), for certain stable TFMs X^(%),Y^(%)∈i (s)^(n×n).

A collection of eight stable TFMs (M, N, M^(%), N^(%), X, Y, X^(%), Y^(%)) is called a doubly coprime factorization of G if M^(%) and M are invertible, yield the factorizations G=M^(%−1)N^(%)=NM⁻¹, and satisfy the following equality (Bézout's identity):

$\begin{matrix} {{\begin{bmatrix} {{- N}\%} & {M\%} \\ Y & X \end{bmatrix}\begin{bmatrix} {{- X}\%} & M \\ {Y\%} & N \end{bmatrix}} = {I_{2n}.}} & (2) \end{matrix}$

Let (M, N, M^(%), N^(%), X, Y, X^(%), Y^(%)) be a doubly coprime factorization of G. Any controller K_(Q) stabilizing the plant G, in the feedback interconnection of FIG. 7, can be written as

K _(Q) =Y _(Q) ⁻¹ X _(Q) =X _(Q) ^(%) Y _(Q) ^(%),  (3)

where X_(Q), X_(Q) ^(%), Y_(Q) and Y_(Q) ^(%) are defined as:

X _(Q)

X+QM ^(%) ,X _(Q) ^(%)

X ^(%) +MQ,Y _(Q)

Y−QN ^(%) ,Y _(Q) ^(%)

Y ^(%) NQ  (4)

for some stable Q in i (s)^(n×n). It also holds that K_(Q) from (3) stabilizes G, for any stable Q in i (s)^(n×n).

Starting from any doubly coprime factorization (2), the following identity

$\begin{matrix} {{\begin{bmatrix} {{- N}\%} & {M\%} \\ Y_{Q} & X_{Q} \end{bmatrix}\begin{bmatrix} {{- X_{Q}}\%} & M \\ {Y_{Q}\%} & N \end{bmatrix}} = {I_{2n}.}} & (5) \end{matrix}$

provides an alternative doubly coprime factorization of G, for any stable Q∈i (s)^(n×n).

For any stabilizing controller K_(Q) from (3), the expression of the closed-loop H (G, K_(Q)) takes the form

$\begin{matrix} {\begin{bmatrix} T_{zw} & T_{zv} \\ T_{uw} & T_{uv} \end{bmatrix} = \begin{bmatrix} {{- Y_{Q}}\% N\%} & {Y_{Q}\% M\%} \\ {{- X_{Q}}\% N\%} & {X_{Q}\% M\%} \end{bmatrix}} & (6) \end{matrix}$

where the block-wise partition in the identity (6) is in accordance with the definitions of (1).

Various embodiments of the present technology consider a platoon of one leader and n∈¥follower vehicles traveling in a straight line along a highway, in the same (positive) direction of an axis with origin at the starting point of the leader. Henceforth, the “0” index will be reserved for the leader. Denote by y₀(t) the time evolution of the position of the leader vehicle, which can be regarded as the “reference” for the entire platoon. The dynamical model for the k-th vehicle in the string, (0≤k≤n) is described by its corresponding LTI, continuous-time, finite dimensional transfer function G_(k)(s) from its controls u_(k)(t) to its position y_(k)(t) on the roadway. While in motion, the k-th vehicle is affected by the disturbance W_(k)(t), additive to the control input u_(k)(t), specifically

y _(k)(t)=G _(k)★(w _(k)(t)+u _(k)(t))  (7)

The control signal u₀(t) of the leader's vehicle may not be automatically generated in some embodiments. In some embodiments, the leader vehicle may or may not have a controller on board. Whether the control signal is automatically generated or not, both u₀ and w₀ act as reference signals for the entire platoon.

One of the goals in some embodiments is for every vehicle in the string to follow the leader while maintaining a certain inter-vehicle spacing distance which denoted with A. If the inter-vehicle spacing policy is assumed to be constant then A is given as a pre-specified positive constant. Under the standard assumptions that all vehicles start at rest

$\left( {{\frac{{dy}_{k}}{dt}(0)} = {{{for}\mspace{14mu} 0} \leq k \leq n}} \right)$

and from the initial desired formation (y_(k)(0)=−kΔ for 0≤k≤n), the time evolution for the position of each vehicle becomes:

y _(k)(t)=G _(k)★(u _(k)(t)+w _(k)(t))−kΔ, for 0≤k≤n.  (8)

Denote with z_(k)(t) the inter-vehicle spacing errors defined as

z _(k)(t)

y _(k−1)(t)−y _(k)(t)−Δ, for 1≤k≤n  (9)

One of the objectives of the control mechanism in various embodiments is to attenuate the effect of the disturbances w_(k), (0≤k≤n), and of the leader's control signal u₀ at each member of the platoon, such as to maintain the spacing errors (9) as close to zero as possible. This “small errors” performance must be attained asymptotically (in steady state) and for a constant speed of the leader. The error signals relate to the performance metrics associated with the platoon (as an aggregated system) when considering safety margins and traffic throughput.

There is no loss of generality in assuming that A=0 in equation (8) or in considering vehicles with different lengths, since these parameters can be “absorbed” as needed in the spacing error signals (9).

In practice an inter-vehicle spacing policy that is proportional with the vehicle's speed

$\frac{{dy}_{k}}{dt}(t)$

(dubbed time headway) is preferred to the constant policy (9). Various time headway policies have been known to have beneficial effects on certain stability measures of the platoon's behavior. For a constant time headway h>0, the expression of the spacing errors becomes

$\begin{matrix} {{{z_{k}(t)}\overset{def}{=}{{y_{k - 1}(t)} - \left( {{y_{k}(t)} + {h\frac{{dy}_{k}}{dt}(t)}} \right)}}{where}{\frac{{dy}_{k}}{dt}(t)}} & (10) \end{matrix}$

is the speed of the k-th vehicle. Under the aforementioned “zero” error initial conditions the vehicle inter-spacing errors can be written as:

z _(k) +=G _(k)★(u _(k) +w _(k))−HG _(k+1)★(u _(k+1) +w _(k+1)),0≤k≤(n−1),  (11)

where

H(s)

hs+1,h>0.  (12)

Next, the following standard notation for the aggregated signals of the platoon will be used:

z

[z ₁ z ₂ K z _(n)]^(T) , w

[w ₁ w ₂ K w _(n)]^(T) , u

[u ₁ u ₂ K u _(n)]^(T).  (13)

Define T∈i (s)^(n×n) as

$\begin{matrix} {T\overset{def}{=}\begin{bmatrix} H & O & O & K & O \\ {- 1} & H & O & K & O \\ O & {- 1} & H & K & O \\ M & M & M & \; & M \\ O & O & O & K & H \end{bmatrix}} & (14) \end{matrix}$

while noting that its inverse is

$\begin{matrix} {T^{- 1} = {{T\left\{ {H^{- 1},H^{- 2},K,H^{- n}} \right\}} = \begin{bmatrix} H^{- 1} & O & O & K & O \\ H^{- 2} & H^{- 1} & O & K & O \\ H^{- 3} & H^{- 2} & H^{- 1} & K & O \\ M & M & M & O & M \\ H^{- n} & H^{{- n} + 1} & H^{{- n} + 2} & K & H^{- 1} \end{bmatrix}}} & (15) \end{matrix}$

Rewriting (11) for all 0≤k≤(n−1) in a matrix form to obtain

$\begin{matrix} {{{{\begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n} \end{bmatrix} = {{\begin{bmatrix} 1 \\ O \\ O \\ M \\ O \end{bmatrix}G_{0}{\bigstar \left( {u_{0} + w_{0}} \right)}} -}}\quad}\begin{bmatrix} {HG}_{1} & O & O & K & O \\ {- G_{1}} & {HG}_{2} & O & K & O \\ O & {- G_{2}} & {HG}_{3} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {HG}_{n} \end{bmatrix}}{\bigstar \begin{bmatrix} \left( {u_{1} + w_{1}} \right) \\ \left( {u_{2} + w_{2}} \right) \\ \left( {u_{3} + w_{3}} \right) \\ M \\ \left( {u_{n} + w_{n}} \right) \end{bmatrix}}} & (16) \end{matrix}$

In view of (16), G

TD{G₁,G₂,K,G_(n),} can be used to denote the aggregated TFM of the platoon, from the controls vector u to the error signals vector z. Henceforward, G will be referred to as the platoon's plant.

With this notation equation (16) can be expressed as

z=V ₁ G ₀★(u ₀ +w ₀)−G★(u+w),  (17)

where V₁

[1 0 K 0] is the first column vector of the Euclidian basis in i ^(n). In our platooning framework the measurements of the platoon's plant are the errors signals z, representing the input signals of the controller K_(Q)∈i (s)^(n×n), therefore the equation for the controls vector reads

u(t)=K _(Q) ★z(t).  (18)

To bridge the gap between our platooning control problem and the generic unity feedback scheme from FIG. 7, (18) can be plugged into (17) in order to obtain the closed-loop H (G, K_(Q)) of the platoon (as an aggregated system).

Given a doubly coprime factorization (2) of the platoon's plant G and a controller K_(Q) (3) then

z=T _(zw) ₀ ★(u ₀ +w ₀)+T _(zw) ★w,  (19a)

u=T _(uw) ₀ ★(u ₀ +w ₀)+T _(uw) ★w,  (19b)

where T_(zw) ₀

(I+GK_(Q))⁻¹V₁G₀ and T_(uw) ₀

K_(Q)K(I+GK_(Q))⁻¹V₁G₀ are the TFMs from the leader's controls and disturbances (u₀+w₀) to the interspacing errors z and control signals u, respectively, while T_(zw) and T_(uw) are as defined in (1), for K=K_(Q). In particular, it holds that

$\begin{matrix} {\begin{bmatrix} T_{{zw}_{0}} & T_{zw} \\ T_{{uw}_{0}} & T_{uw} \end{bmatrix} = {\begin{bmatrix} {Y_{Q}^{\%}M^{\%}V_{1}G_{0}} & {{- Y_{Q}^{\%}}N^{\%}} \\ {X_{Q}^{\%}M^{\%}V_{1}G_{0}} & {{- X_{Q}^{\%}}N^{\%}} \end{bmatrix}.}} & (20) \end{matrix}$

This can be seen by plugging (18) into (17) in order to get (19a). Next, note that because of (1) it holds that T_(zw) ₀ =T_(zv)V₁G₀ and substitute accordingly the expression from (6) of into (19a) in order to obtain T_(zw) ₀ in (20). By plugging (18) into (17) gives u=K_(Q)(V₁G₀★(u₀+w₀)−G★w−G★u) which yields (19b). Note that also because of (1) it holds that T_(uw) ₀ =T_(uv)V₁G₀ and substitute accordingly the expression from (6) into (19b) in order to get T_(uw) ₀ in (20). The remaining expressions in (20) follow directly from the results presented above.

Clearly, from (20) it appears that the stability of T_(zw) ₀ or T_(uw) ₀ cannot be guaranteed by an internally stabilizing controller K_(Q) for any leader dynamics G₀. However, this issue can be solved under lenient assumptions, as explained later in the sequel.

A controller K_(Q)∈i (s)^(n×n) is said to be a leader information controller, if K_(Q) stabilizes the platoon's plant G in the feedback configuration of FIG. 7 and the TFM T_(zw) ₀ =(I_(n)+GK_(Q))⁻¹ from the disturbances at the leader to the errors is diagonal.

It turns out that imposing bi-diagonal sparsity constraints on the closed-loop TFM (I_(n)+GK_(Q))⁻¹ (from the disturbances to the leader w₀(t) to the errors vector z(t)) arises as a natural performance condition in multi-agent platooning systems due to the fact that such sparsities of the closed-loop TFMs are intimately related to the manner in which the disturbances propagate through the string formation.

The vehicle's linearized dynamics are commonly modeled in the literature as a second order system including damping or as a double integrator with first order actuator dynamics. In some embodiments, heterogeneous vehicles properties may be modeled with the distinct masses and the distinct actuating time constants corresponding to the different types of vehicles in the platoon (e.g. heavy vehicles versus automobiles).

The dynamical model G_(k) for each vehicle k, 0≤k≤n, equals a given strictly proper transfer function

(s)∈i (s) weighted by a unimodular factor Φ_(k)∈i (s), specifically G_(k)

Φ_(k)

, where we call a transfer function matrix unimodular if it is stable and has a stable inverse. The expression of the platoon's plant therefore becomes G=TΦG

_(.)

One possible embodiment could comprise of a point-mass model comprising of the double integrator with a first order actuator (ρ_(k)>0),

$\begin{matrix} {{{G_{k}(s)} = \frac{s + \sigma_{k}}{m_{k}{s^{2}\left( {{\rho_{k}s} + 1} \right)}}},{{{for}\mspace{14mu} 1} \leq k \leq n},} & (21) \end{matrix}$

G

_(would be the double integrator) 1/s² and Φ_(k) would be equal to

$\frac{s + \sigma_{k}}{m_{k}\left( {{\rho_{k}s} + 1} \right)}$

with σ_(k)>0, where m_(k) and ρ_(k) are the mass and actuator time constant respectively, specific to the k-th vehicle.

Since zero at −σ_(k) in the expression of Φ_(k) is stable, it actually does not introduce important restrictions, and can be cancelled in closed-loop.

In some embodiments, the transfer function G

_(described above may include a conveniently designed Pade rational approximation of e) ^(−τ) ^(k) ^(s) where τ_(k) is the time delay of the vehicle's electro-hydraulic brake and throttle actuating system. The actuating time delay τ_(k) may be the same for all n vehicles in the platoon, and the leader vehicle or different vehicles in the string may have different time delay actuating constants τ_(k). A common time delay constant for all vehicles in the string may be negotiated between the vehicles in the string using communications protocols, and it may be implemented by the synchronization mechanism present onboard each vehicle.

Such a common time delay constant may be chosen to be greater or equal to the maximum of the actuating time delays of all vehicles present in formation. Such a common time delay may be chosen to greater or equal with the maximum of the latencies of the vehicles in the string and it may be implemented by the synchronization mechanism. The vehicle latency has been defined earlier. The actuating time delay τ_(k) for each vehicle is known in practice from the vehicle's technical specifications and can be further certified through model validation methods. It is also known that the Pade approximation will introduce non-minimal phase zeros in G

_(and therefore some loss of performance.)

The Youla Parameterization of All Leader Information Controllers

This subsection describes the Youla parameterization of all leader information controllers associated with a given platoon of vehicles. Some embodiments can be formulated in terms of a particular doubly coprime factorization of the platoon's plant, whose factors feature certain sparsity patterns. Parameterizing all leader information controllers translates into restricting the set of the Youla parameters only to those having a diagonal TFM.

The n×n Transfer Function Matrix (H⁻¹T) with the constant time-headway H(s)=+hs, (with h>0) and T as defined in (14) is a unimodular TFM.

This statement follows from the fact that (H⁻¹T) has all its poles and all its Smith zeros at

${- \frac{1}{h}},$

where h>0 as specified in (12).

Let (M_(p), N_(p), M_(p) ^(%), N_(p) ^(%), X_(p), Y_(p), X_(p) ^(%), Y_(p) ^(%)) be a doubly coprime factorization of G

_(, where all eight factors are scalar rational functions, with N) _(p) ^(%) and N_(p) strictly proper, because G

_(is assumed strictly proper in Assumption IV.)3. Then: (A) There exists a doubly coprime factorization (2) of G, denoted (M,N, M^(%), N^(%), X, Y, X^(%), Y^(%)), and having the following expression

$\begin{matrix} {{\begin{bmatrix} {- N^{\%}} & M^{\%} \\ Y & X \end{bmatrix}\overset{def}{=}\begin{bmatrix} {{- N_{\wp}}T\; \Phi} & {M_{\wp}^{\%}I_{n}} \\ {Y_{\wp}H^{- 1}T\; \Phi} & {X_{\wp}H^{- 1}I_{n}} \end{bmatrix}},} & \left( {22a} \right) \\ {{\begin{bmatrix} {- X^{\%}} & M \\ Y^{\%} & N \end{bmatrix} = \begin{bmatrix} {{- \Phi^{- 1}}T^{- 1}X^{\%}} & {\Phi^{- 1}T^{- 1}{HM}_{\wp}} \\ {Y_{\wp}^{\%}I_{n}} & {{HN}_{\wp}I_{n}} \end{bmatrix}};} & \left( {22b} \right) \end{matrix}$

(B) The Youla parameterization (3) of all leader information stabilizing controllers (from Definition IV.1) is obtained from the doubly coprime factorization (22) by constraining the Youla parameters Q∈i (s)^(n×n) to be diagonal, specifically Q

D{Q₁₁,Q₂₂,K,Q_(m)}, with Q_(kk)∈i (s) stable, for any 1≤k≤n. Moreover, any leader information controller K_(Q) is given by a left coprime factorization of the form

[Y _(Q) X _(Q)]

[(H ⁻¹ Y _(p) I _(n) −N _(p) ^(%) Q)TΦ(H ⁻¹ X _(p) I _(n) +M _(p) ^(%) Q)].  (23)

The detailed expressions of the factors Y_(Q) and X_(Q) are given by

$\begin{matrix} {Y_{Q} = \begin{bmatrix} {\left( {Y_{\wp} - {Q_{11}{HN}_{\wp}^{\%}}} \right)\Phi_{1}} & O & O & K & O \\ {\left( {{{- H^{- 1}}Y_{\wp}} + {Q_{22}N_{\wp}^{\%}}} \right)\Phi_{1}} & {\left( {Y_{\wp} - {Q_{22}{HN}_{\wp}^{\%}}} \right)\Phi_{2}} & O & K & O \\ O & {\left( {{{- H^{- 1}}Y_{\wp}} + {Q_{33}N_{\wp}^{\%}}} \right)\Phi_{2}} & {\left( {Y_{\wp} - {Q_{33}{HN}_{\wp}^{\%}}} \right)\Phi_{3}} & K & O \\ M & M & M & M & M \\ O & O & O & K & {\left( {Y_{\wp} - {Q_{nm}{HN}_{\wp}^{\%}}} \right)\Phi_{n}} \end{bmatrix}} & \left( {24a} \right) \end{matrix}$

$\begin{matrix} {X_{Q} = \begin{bmatrix} \left( {{H^{- 1}X_{\wp}} + {Q_{11}M_{\wp}^{\%}}} \right) & O & O & K & O \\ O & \left( {{H^{- 1}X_{\wp}} + {Q_{22}M_{\wp}^{\%}}} \right) & P & K & O \\ O & P & \left( {{H^{- 1}X_{\wp}} + {Q_{33}M_{\wp}^{\%}}} \right) & K & O \\ M & M & M & M & M \\ O & O & O & K & \left( {{H^{- 1}X_{\wp}} + {Q_{nm}M_{\wp}^{\%}}} \right) \end{bmatrix}} & \left( {24b} \right) \end{matrix}$

Statement (A) can be seen by the fact that both T⁻¹ from (15) and HT⁻¹ from Proposition IV.6 are stable, implies that all eight factors from (22) are stable. The rest of the proof follows by the inspection of (22) which complies with the definition from (2). Statement (B) The TFM of interest (I_(n)+GK_(Q))⁻¹ is diagonal if and only if (I_(n)+GK_(Q))⁻¹(M_(p) ^(%))⁻¹=Y_(Q) ^(%) is diagonal. The latter holds if and only if (Y_(Q) ^(%)−Y_(p) ^(%)I_(n)) is diagonal. But from the expression for Y_(Q) from (4) applied to the factorization in (22) it follows that Y_(Q) ^(%)=Y_(p) ^(%)I_(n)+(HN_(p) )Q and since neither N_(p), nor H are identically zero, clearly Y_(Q) ^(%) is diagonal if and only if the Youla parameter Q is a diagonal TFM. The formulas from (24) follow directly.

Distributed Implementation of Leader Information Controllers

This subsection introduces a distributed implementation for leader information controllers that can be used in various embodiments of the present technology.

Any of the leader information controllers K_(Q), u=K_(Q)z, parameterized in above can be rewritten as

u=H ⁻¹Φ_(ldiag) ★u+H ⁻¹ K★z  (25)

with

$\begin{matrix} {\Phi_{ldiag}\overset{def}{=}\begin{bmatrix} O & O & O & K & O & O \\ {\Phi_{2}^{- 1}\Phi_{1}} & O & O & K & O & O \\ O & {\Phi_{3}^{- 1}\Phi_{2}} & O & K & O & O \\ O & O & {\Phi_{4}^{- 1}\Phi_{3}} & K & O & O \\ M & M & M & O & M & M \\ O & O & O & K & {\Phi_{n}^{- 1}\Phi_{N - 1}} & O \end{bmatrix}} & (26) \end{matrix}$ K

{K ₁ ,K ₂ ,K,K _(n) },K _(k)

Φ_(k) ⁻¹(Y _(p) −Q _(kk) HN _(p) ^(%))⁻¹(X _(p) +Q _(kk) HM _(p) ^(%)), with K _(k)∈i (s),  (27)

for any 1≤k≤n.

This follows directly by multiplying to the left coprime factorization (23) of K_(Q) with the diagonal TFM

D{Φ ₁ ⁻¹ H ⁻¹(H ⁻ Y _(p) −Q ₁₁ N _(p) ^(%))⁻,Φ₂ ⁻¹ H ⁻¹(H ⁻ Y _(p) −Q ₂₂ N _(p) ^(%))⁻ ,K,Φ _(n) ⁻¹ H ⁻¹(H ⁻ Y _(p) −Q _(nn) N _(p) ^(%))⁻}

A distributed implementation of the leader information controller is presented in FIG. 8 for the first three vehicles of the platoon. The scheme for any two consecutive vehicles in the platoon (k>2) is depicted in FIG. 9 where the Ψ blocks are considered to be equal to 1. The blocks G_(k) (with 1≤k≤n) represent the dynamical models of the vehicles and each control signal u_(k) is fed in the Electrohydraulic Braking and Throttle actuation system on board the k-th vehicle. The z_(k) measurement, represents the distance to the preceding vehicle and it is measured using ranging sensors on board the k-th vehicle. The control signal u_(k−1) produced on board the (k−1)-th vehicle is broadcasted (e.g., using wireless communications) to the k-th vehicle. The blocks Ψ are taken to be 1 in FIG. 9 under the assumption that there are no (wireless) communications induced delays.

To make the graphics more readable, FIG. 8 and FIG. 9 illustrate the case in which the constant time-headway policy has been removed, meaning that H(s)=1 is being considered. However, the implementation for H(s)=hs+1 with h>0 should become straightforward from equation (25): simply add a cascaded H filter on each of the u_(k) and z_(k+1), branches and add a H filter on each feedback branch from y_(k) to z_(k) (in accordance to the definition of the error signals z_(k) from (11)) as described in FIG. 10 and FIG. 11. The Φ_(k), Φ_(k−1), and K_(k) blocks represent LTI filters and their implementation may be realized by the digital controller onboard each vehicle.

Performance of Leader Information Controllers

This section describes the performance characteristics of leader information controllers. The discussion is twofold: 1) A structural feature of any leader information controller which determines the non-propagation of disturbances downstream the platoon is presented; and 2) How leader information controllers perform in achieving disturbances attenuation (via norm-based costs) are examined.

Structural Properties of Leader Information Controllers

As a structural property of any leader information controller, the resulted closed-loop TFM T_(zw) is lower bidiagonal. This implies that any disturbance w_(j) (at the j-th vehicle in the platoon) will only impact the z_(j) and z_(j+1), error signals. Consequently, any disturbance at the j-th vehicle is completely attenuated before even propagating to the (j+2)-th vehicle in the string.

Furthermore, since the TFM T_(zw) ₀ is diagonal, the disturbances w₀ at the leader's vehicle influence only the z₁ error signal and none of the subsequent errors z_(k), with k≥2. Similarly, the leader's control signal u₀ impacts only the z₁ error signal, and not at all the subsequent errors z_(k), with k≥2. This is relevant to the current discussion, since u₀ may not be automatically generated and so it constitutes a reference signal for the entire platoon. This feat of leader information controllers practically eliminates the so-called accordion effect from the behavior of the platoon. In contrast, for any of the predecessor-follower type schemes (including bi-directional or multi look-ahead schemes), since T_(zw) is lower triangular, disturbances at the j-th vehicle—even if attenuated—affect the inter-spacing errors of all its successors in the platoon, therefore exhibiting the accordion effect. The following result provides the exact expressions of the closed-loop TFMs achievable with leader information controllers.

Given a doubly coprime factorization (22) of the platoon's plant G and Q

D{Q₁₁,Q₂₂,K,Q_(nn)} a diagonal Youla parameter, it holds that:

-   -   (A) The closed loop transfer function from the disturbance w₀     -   i) to the interspacing error signals z_(k) is given by

$\begin{matrix} {T_{z_{k}w_{0}} = \left\{ \begin{matrix} {{\left( {Y_{\wp}^{\%} - {{HN}_{\wp}Q_{11}}} \right)N_{\wp}^{\%}\Phi_{0}},} & {{{{for}\mspace{14mu} k} = 1},} \\ {0,} & {{{{for}\mspace{14mu} k} \geq 2};} \end{matrix} \right.} & (28) \end{matrix}$

-   -   ii) to the control signals u_(k) is given by

T _(u) _(k) _(w) ₀ =(X _(p) ^(%) +HM _(p) Q ₁₁)N _(p) ^(%)Φ₀Φ_(k) ⁻¹ H ^(−k).  (29)

(B) The closed loop transfer function from the disturbance w_(j)

-   -   i) to the error signals z_(k) is given by

$\begin{matrix} {T_{z_{k}w_{0}} = \left\{ \begin{matrix} {0,} & {{{{for}\mspace{14mu} k} < j},} \\ {{{- \left( {Y_{\wp}^{\%} - {{HN}_{\wp}Q_{jj}}} \right)}N_{\wp}^{\%}\Phi_{j}},} & {{{{for}\mspace{14mu} k} = j},} \\ {{\left( {Y_{\wp}^{\%} - {{HN}_{\wp}Q_{{({j + 1})}{({j + 1})}}}} \right)N_{\wp}^{\%}\Phi_{j}},} & {{{{for}\mspace{14mu} k} = {j + 1}},} \\ {0,} & {{{{for}\mspace{14mu} k} > {j + 1}};} \end{matrix} \right.} & (30) \end{matrix}$

-   -   ii) to the control signals u_(k) is given by

$\begin{matrix} {T_{u_{k}w_{j}} = \left\{ \begin{matrix} {0,} & {{{{for}\mspace{14mu} k} < j},} \\ {{{- \left( {X_{\wp}^{\%} + {{HM}_{\wp}Q_{jj}}} \right)}N_{\wp}^{\%}},} & {{{{for}\mspace{14mu} k} = j},} \\ {{- {M_{\wp}\left( {Q_{jj} - Q_{{({j + 1})}{({j + 1})}}} \right)}}N_{\wp}^{\%}\Phi_{j}\Phi_{k}^{- 1}H^{j + 1 - k}} & {{{for}\mspace{14mu} k} > {j.}} \end{matrix} \right.} & (31) \end{matrix}$

These results follow by the inspection of the closed-loop TFMs from the disturbances w₀ and w to the errors z and to the control signals u, respectively. The TFM from the disturbances to the errors expressed in terms of the particular doubly coprime factors from (22) reads (according to Proposition III.3)

z=(Y _(p) ^(%) I _(n) −HN _(p) Q)M _(p) ^(%) G _(p) Φ₀ V ₁ ^(n) ★w ₀−(Y _(p) ^(%) −HN _(p) Q)N _(p) ^(%) TΦ★w  (32)

which implies (28) and (30), respectively. Furthermore, the TFM from the disturbances w₀ and w respectively, to the controls u expressed in terms of the doubly coprime factors from (22) reads:

u=Φ ⁻¹ T ⁻¹(X _(p) ^(%) +HM _(p) Q)M _(p) ^(%) G _(p) Φ₀ V ₁ ★w ₀−Φ⁻¹ T ⁻¹(X _(p) ^(%) +HM _(p) Q)N _(p) TΦ★*w  (33)

which in turn yields (29) and (31), respectively.

In some embodiments, any leader information controller K, also stabilizes T_(zw) ₀ , and T_(uw) ₀ .

Note that according to (29), the disturbances w₀ affecting the leader vehicle influence the control signals u_(k) of all other vehicles in the platoon since the controls of all followers act to compensate the effect of w₀ on the inter-spacing errors. (The same statement holds true for the leader's controls u₀, as well. The leader's controls u₀ influence all other control signals u_(k), with k≥21.) Interestingly enough, it turns out that this is not necessarily the case for disturbances at the following vehicles. By taking the diagonal Youla parameters to have identical diagonal entries then the closed-loop TFM T_(uw)(s) becomes diagonal and consequently the disturbances w, at the j-th vehicle are only “felt” on the controls of the j-th vehicle u_(j) and not at all for its successors.

Considerations on Local and Global Optimality

One of the canonical problems in classical control (dubbed disturbances attenuation) is to design the controller which minimizes some specified norm of the closed-loop TFM from the disturbances w to the error signals z, namely T_(zw)(s). In the platooning setting, an elementary question one should ask is: what level of disturbances attenuation can be attained by leader information controllers with respect to the local performance cost ∥T_(z) _(j) _(w) _(j) from (30) at each vehicle (1≤j≤n) in the platoon). The following result shows that constraining the stabilizing controller to be a leader information controller, does not cause any loss in local performance, irrespective of the chosen norm (relative to the performance achievable by the centralized optimal controller).

For any 1≤j≤n, the minimum in

$\begin{matrix} {{\min \mspace{14mu} {T_{z_{j}w_{j}}}}{K_{Q}\mspace{14mu} {stabilizes}\mspace{14mu} G}} & (34) \end{matrix}$

is attained by a leader information controller. The norm in (34) can be taken to be either the H₂ or the H_(∞) norm.

In order to account for any stabilizing controller K_(Q) in (34) (possibly centralized controllers), the diagonal constraints on the Youla parameter are removed and generic Youla parameters Q∈i (s)^(n×n) are considered. Expressing T_(zw) from (20) in terms of the doubly coprime factorization (22) yields

T _(zw)=−(Y _(p) ^(%) −HN _(p) Q)N _(p) ^(%) TΦ.  (35)

Note that since Q is no longer assumed to be diagonal, T_(zw) in (35) is no longer lower bidiagonal. Taking (35) into account for the expression of the cost function in (34) it can be observed that T_(z) _(j) _(w) _(j) depends only on the Q_(jj),Q_(j(j+1)) entries of the Youla parameter, in particular

T _(z) _(j) _(w) _(j) =Y _(p) ^(%) N _(p) ^(%) +N _(p) (Q _(jj) −Q _(j(j+1)))N _(p) ^(%), for any 1≤j≤n,  (36a)

T _(z) _(j) _(w) _(j−1) =Y _(p) ^(%) N _(p) ^(%) +N _(p) (Q _(j(j−1)) −Q _(jj))N _(p) ^(%), for any 2≤j≤n.  (36b)

Rewriting (34) in accordance with (36) to get

$\begin{matrix} {{\min \mspace{14mu} {{{{{- Y_{\wp}^{\%}}N_{\wp}^{\%}H\; \Phi_{j}} + {{{HN}_{\wp}\left( {{Q_{jj}H} - Q_{j{({j + 1})}}} \right)}N_{\wp}^{\%}\Phi_{j}}}}.Q_{jj}}},{Q_{j{({j + 1})}} \in {{¡(s)}Q_{jj}}},{Q_{j{({j + 1})}}\mspace{14mu} {stable}}} & (37) \end{matrix}$

It can be observed that if denoting T₁

−Y_(p) ^(%)N_(p) ^(%)HΦ_(j) and T₂

[HN_(p) HN_(p) ^(%)Φ_(j)−HN_(p) N_(p) ^(%)Φ_(j)], with T₁∈i (s) and T₂∈i (s)^(1×2), then (37) is further equivalent to

$\begin{matrix} {{{\min \mspace{14mu} {{T_{1} + {T_{2}\begin{bmatrix} Q_{jj} \\ Q_{j{({j + 1})}} \end{bmatrix}}}}},Q_{jj},{Q_{j{({j + 1})}} \in {¡(s)}}}{Q_{jj},{Q_{j{({j + 1})}}\mspace{14mu} {stable}}}} & (38) \end{matrix}$

which is a standard model-matching problem which can be solved efficiently for the optimal Q_(jj),Q_(j(j+1)). Note that after taking all products, the factors involved in the model-matching problem end up being proper transfer functions. The cause of this is the expression (12) of the improper H combined with the fact that both N_(p) and N_(p) ^(%) are strictly proper. Furthermore, it can be observed that if Q_(jj)*,Q_(j(j+1))* is a solution to (37) then Q_(jj) ^(%)=Q_(jj)*−Q_(j(j+1))H⁻¹,Q_(j(j+1)) ^(%)=0 is also a solution to (37). Therefore the minimum can be attained for each one of the n local cost-functions from (34), via the diagonal Youla parameter Q*

D{Q₁₁ ^(%),Q₂₂ ^(%),K,Q_(nn) ^(%)}, which plugged into (24) yields the optimal leader information controller.

Practical H_(∞) Criterion for Controller Design

The i-th Local Problem.

In practice, the local performance objective at the j-th vehicle in the platoon (1≤j≤n) is formulated as to minimize the effect of the disturbances w_(j) (at the j-th vehicle) both on the interspacing error z_(j) and on the control effort u_(j), namely

$\begin{matrix} {{\min \mspace{14mu} {\begin{bmatrix} T_{z_{j}w_{j}} \\ T_{u_{j}w_{j}} \end{bmatrix}}_{\infty}}{K_{Q}\mspace{14mu} {stabilizes}\mspace{14mu} G}{K_{Q}\mspace{14mu} {leader}\mspace{14mu} {information}\mspace{14mu} {controller}}} & (39) \end{matrix}$

The closed-loop TFM from the disturbances to the controls is included in the cost in order to avoid actuator saturation, to regulate the control effort but also to set “the road attitude” of the j-th vehicle. The H_(∞) norm is used in order to guarantee attenuation in “the worst case scenario”. The problem in (39) is referred to as the j-th local problem. A convenient feature of the leader information controllers is that both closed-loop terms T_(z) _(j) _(w) _(j) and T_(u) _(j) _(w) _(j) involved in the cost functional of (39) depend only on the Q_(jj) entry of the diagonal Youla parameter. Therefore, while performing the minimization in (39) after all stabilizing leader information controllers, the j-th local problem (39) can be recast as the following H_(∞) model-matching problem:

$\begin{matrix} {{{\min \mspace{14mu} {{{{\begin{bmatrix} {- H\; \Phi_{j}} \\  -  \end{bmatrix}} + {H{\begin{bmatrix} {H\; \Phi_{j}} \\  -  \end{bmatrix}}Q_{jj}}}}_{\infty}.Q_{jj}}} \in {¡(s)}}{Q_{jj}\mspace{11mu} {stable}}} & (40) \end{matrix}$

Note that (40) can be efficiently solved for Q_(jj) using existing H_(∞) synthesis numerical routines. Furthermore, a leader information controller can be always be designed that simultaneously solves the local problems for each one of the n vehicles in the string. This is done by solving independently (in parallel, if needed) each j-th local problem, for the j-th diagonal entry Q_(jj) of the Youla parameter. When plugged into the leader controller parameterization, the resulted diagonal Youla parameter yields the expression for the local controllers K_(k) to be placed on board the k-th vehicle, (1≤k≤n).

The local performance objectives imposed in (39) are not sufficient to guarantee the overall behavior of the platoon. The standard analysis for platooning systems must take into account the effects of the disturbance w_(j) (at any j-th vehicle in the platoon or at the leader) on the errors z_(k) and controls u_(k), for all successors in the string (k>j). As a bonus feature of leader information controllers, the effect of the disturbances w_(j) on any of its successors k in the string does not formally depend on the number (k−j) of in-between vehicles but only on the following factors: (i) the attenuations obtained at the j-th and (j+1)-th local problems, respectively (which are optimized by design in (39)); (ii) the stable, minimum phase dynamics Φ_(j) and Φ_(k) particular to the j-th and the k-th vehicle, respectively; and (iii) the constant time-headway H. In particular, the effect of the disturbances w₀ at the leader on any successor k≥1 in the string depends on the following: (i) the attenuation obtained at the 1-st local problem; (ii) the stable, minimum phase dynamics Φ₀ and Φ_(k) particular to the leader and the k-th vehicle, respectively; and (iii) the constant time-headway H. The precise statement follows:

For any leader information controller, the propagation effect of the disturbances towards the back of the platoon (sensitivity to disturbances) is bounded as follows:

(A) The amplification of the disturbance w₀(to the leader's vehicle) on

-   -   i) the first vehicle in the platoon is given by

$\begin{matrix} {{{\begin{bmatrix} T_{z_{1}w_{0}} \\ T_{u_{1}w_{0}} \end{bmatrix}}_{\infty} = {{{{- \Phi_{1}^{- 1}}\Phi_{0}{H^{- 1}\begin{bmatrix} T_{z_{1}w_{1}} \\ T_{u_{1}w_{1}} \end{bmatrix}}}}_{\infty} \leq {{{\Phi_{1}^{- 1}\Phi_{0}H^{- 1}}}_{\infty}{\begin{bmatrix} T_{z_{1}w_{1}} \\ T_{u_{1}w_{1}} \end{bmatrix}}_{\infty}}}};} & (41) \end{matrix}$

-   -   ii) the k-th vehicle in the platoon, with k≥2, is given by

$\begin{matrix} {{\begin{bmatrix} T_{z_{k}w_{0}} \\ T_{u_{k}w_{0}} \end{bmatrix}} = {{{\begin{bmatrix} O & O \\ O & {{- \Phi_{k}^{- 1}}\Phi_{0}H^{- k}} \end{bmatrix}\begin{bmatrix} T_{z_{1}w_{1}} \\ T_{u_{1}w_{1}} \end{bmatrix}}}_{\infty} \leq {{{\Phi_{k}^{- 1}\Phi_{0}H^{- k}}}_{\infty}{{\begin{bmatrix} T_{z_{1}w_{1}} \\ T_{u_{1}w_{1}} \end{bmatrix}}_{\infty}.}}}} & (42) \end{matrix}$

(B) The amplification of disturbances w

-   -   i) on the (j+1)-th vehicle is given by

$\begin{matrix} {{{\begin{bmatrix} T_{z_{k}w_{j}} \\ T_{u_{k}w_{j}} \end{bmatrix}}_{\infty} = {{{{\begin{bmatrix} {- H^{- 1}} & O \\ O & {\Phi_{j}\Phi_{j + 1}^{- 1}} \end{bmatrix}\begin{bmatrix} T_{z_{j}w_{j}} \\ T_{u_{j}w_{j}} \end{bmatrix}} - {\begin{bmatrix} O & O \\ O & {\Phi_{j}\Phi_{k}^{- 1}} \end{bmatrix}\begin{bmatrix} T_{z_{j + 1}w_{j + 1}} \\ T_{u_{j + 1}w_{j + 1}} \end{bmatrix}}}}_{\infty} \leq \leq {{{\begin{bmatrix} {- H^{- 1}} & O \\ O & {\Phi_{j}\Phi_{j + 1}^{- 1}} \end{bmatrix}}_{\infty}{\begin{bmatrix} T_{z_{j}w_{j}} \\ T_{u_{j}w_{j}} \end{bmatrix}}} + {{\begin{bmatrix} O & O \\ O & {\Phi_{j}\Phi_{j + 1}^{- 1}} \end{bmatrix}}_{\infty}{\begin{bmatrix} T_{z_{j + 1}w_{j + 1}} \\ T_{u_{j + 1}w_{j + 1}} \end{bmatrix}}_{\infty}}}}};} & (43) \end{matrix}$

-   -   ii) on the k-th vehicle, with k≥j+2, is given by

$\begin{matrix} {{\begin{bmatrix} T_{z_{k}w_{j}} \\ T_{u_{k}w_{j}} \end{bmatrix}}_{\infty} = {{{{\begin{bmatrix} O & O \\ O & {\Phi_{j}\Phi_{k}^{- 1}H^{j + 1 - k}} \end{bmatrix}\begin{bmatrix} T_{z_{j}w_{j}} \\ T_{u_{j}w_{j}} \end{bmatrix}} - {\quad{\begin{bmatrix} O & O \\ O & {\Phi_{j}\Phi_{k}^{- 1}H^{j + 1 - k}} \end{bmatrix}\begin{bmatrix} T_{z_{j + 1}w_{j + 1}} \\ T_{u_{j + 1}w_{j + 1}} \end{bmatrix}}}_{\infty}} \leq \leq {{{{\Phi_{j}\Phi_{k}^{- 1}H^{j + 1 - k}}}_{\infty}{\begin{bmatrix} T_{z_{j}w_{j}} \\ T_{u_{j}w_{j}} \end{bmatrix}}_{\infty}} + {{{\Phi_{j}\Phi_{k}^{- 1}H^{j + 1 - k}}}_{\infty}{{\frac{T_{z_{j + 1}w_{j + 1}}}{T_{u_{j + 1}w_{j + 1}}}}_{\infty}.}}}}}} & (44) \end{matrix}$

These statements follow by straightforward algebraic manipulations of the expressions of the closed-loop TFMs and by the sub-multiplicative property of the H_(∞) norm.

Consider constant inter-spacing policies (or, equivalently, by taking the expression of the constant time-headway H(s)=1), then the attenuation bounds discussed above do not depend on the number (k−j) of in-between vehicles. This is consistent with the traditional definitions for string stability of platoon formations. Furthermore, considering constant time-headway policies then the negative powers of the constant time-headway H(s) having subunitary norm, will introduce additional attenuation, especially at high frequency via the strong effect of the roll-off.

A remarkable feature of the leader information controller is the fact that when dealing with merging traffic the only needed reconfiguration of the global scheme is at the follower of the merging vehicle, which must acknowledge the “new” unimodular factor Φ_(k) of the vehicle appearing in front of it. Such a maneuver can be looked at as a disturbance to the merging vehicle, to be quickly attenuated by the control scheme. Equally important, if the broadcasting of any vehicle in the platoon gets disrupted, then the global scheme can easily reconfigure, such that the non-broadcasting vehicle becomes the leader of a new platoon.

Compensation of Time-Delays Via Accurate Synchronization

This section looks at the factual scenario when there exists a time delay on each of the feedforward links u_(k), with 1≤k≤(n−1). In practice, these delays are caused by the physical limitations of the wireless communications system used for the implementation of the feedforward link, entailing a time delay e^(−θs) (with θ typically around 20 ms) at the receiver of the broadcasted u_(k) signal (with 1≤k≤(n−1)). Other wireless communications systems based on high frequency digital radio, such as Wi-Fi, ZigBee, Bluetooth and the like may have longer or shorter delays depending on the particular hardware and software implementation. In practice, the time delays will be time-varying. One embodiment of the synchronization mechanism described here is able to cope with the time variance and heterogeneity of the communications induced time delays. This may be done by the synchronization operation which can simulate/implement identical, fixed, commensurate time delays. The identical time delays implemented by the synchronization operation may be chosen to be greater or equal with the worst case scenario of the communications induced time delays. This type of situation is represented in FIG. 9, by considering the w blocks to be equal to e^(−θs), with θ≠0. The synchronization mechanism can induce identical latencies for all vehicle which may be chose to be equal to the maximum of the latencies of all vehicles.

In the presence of such time delays in the implementation of the leader information controllers described above, the diagonal sparsity pattern of the resulted closed-loop TFM T_(zw) ₀ is compromised as it becomes lower triangular and no longer satisfies criteria for some of the embodiments discussed above. This means that the resulted (wireless communications based) physical implementation of any controller will in fact not be a bona fide leader information controller. Furthermore, it can be shown that the effects of the communications delays drastically alter the closed loop performance as they necessarily lead to string instability.

The Effect of Communications Time Delays on the Control Performance

In order to make our point with illustrative simplicity let us consider (for this subsection only) the case of platoons with identical vehicles (i.e., Φ_(k)=1, for all 1≤k≤n) and constant interspacing policies, (i.e., H(s)=1). Under these assumptions, the equation of the controller from FIG. 9, with Ψ=e^(−θs), reads:

$\begin{matrix} {\begin{bmatrix} u_{1} \\ u_{2} \\ u_{3} \\ M \\ u_{n - 1} \\ u_{n} \end{bmatrix} = {{{{\quad\quad}\begin{bmatrix} O & O & O & K & O & O \\ e^{{- \theta}\; s} & O & O & K & O & O \\ O & e^{{- \theta}\; s} & O & K & O & O \\ O & O & e^{{- \theta}\; s} & O & O & O \\ M & M & M & O & M & M \\ O & O & O & L & e^{{- \theta}\; s} & O \end{bmatrix}}{\quad{\bigstar \begin{bmatrix} u_{1} \\ u_{2} \\ u_{3} \\ M \\ u_{n - 1} \\ u_{n} \end{bmatrix}}\quad}} + {\quad{\begin{bmatrix} K_{1} & O & O & K & O & O \\ O & K_{2} & O & K & O & O \\ O & O & K_{3} & K & O & O \\ O & O & O & O & O & O \\ M & M & M & O & M & O \\ O & O & O & K & O & K_{n} \end{bmatrix}{\bigstar \begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n - 1} \\ z_{n} \end{bmatrix}}}}}} & (45) \end{matrix}$

or equivalently

$\begin{matrix} {\begin{bmatrix} u_{1} \\ u_{2} \\ u_{3} \\ M \\ u_{n - 1} \\ u_{n} \end{bmatrix} = {\begin{bmatrix} 1 & O & O & K & O & O \\ e^{{- \theta}\; s} & 1 & O & K & O & O \\ e^{{- 2}\theta \; s} & e^{{- \theta}\; s} & 1 & K & O & O \\ e^{{- 3}\theta \; s} & e^{{- 2}\theta \; s} & e^{{- \theta}\; s} & O & O & O \\ M & M & M & O & M & M \\ e^{{({{- n} + 1})}\theta \; s} & e^{{({{- n} + 2})}\theta \; s} & e^{{({{- n} + 3})}\theta \; s} & K & e^{{- \theta}\; s} & 1 \end{bmatrix}{\quad{\begin{bmatrix} K_{1} & O & O & K & O & O \\ O & K_{2} & O & K & O & O \\ O & O & K_{3} & K & O & O \\ O & O & O & O & O & O \\ M & M & M & O & M & O \\ O & O & O & K & O & K_{n} \end{bmatrix}{\bigstar \begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n - 1} \\ z_{n} \end{bmatrix}}}}}} & (46) \end{matrix}$

As a result, any leader information controller, belongs to the following set S, defined as

S

{K∈i (s)^(n×n) |K=T ⁻¹ D{D ₁₁ ,D ₂₂ K D _(nn)} with D _(jj)∈i (s),1≤j≤n}.  (47)

The argument follows by straight forward algebraic manipulations starting from the right coprime factorization K_(Q)=X_(p) ^(%)Y_(p) ^(%1) of any leader information controller. Clearly, the controller from (46) belongs to the set S in (47) (and is therefore a leader information controller) if and only if θ=0 or, equivalently, in the absence of any communications delay. From (46) that the time-delays propagate “through the controller” downstream the platoon and the delays accumulate toward the end of the platoon, in a manner depending on the number of vehicles in the string (specifically n).

The basic fact known in control theory that the delay e^(−θs) (on any of the feedforward channels u_(k), with 1≤k≤n) cannot be efficiently compensated by a series connection with a linear filter on the feedforward path, such as a rational function approximation of the anticipative element e^(θs), that would “cancel out” the effect of the delay.

The Delays Compensation Mechanism Using Synchronization

This subsection shows how the communications induced delays can be compensated at the expense of a negligible loss in performance. By placing a delay of exactly θ seconds on each of the sensor measurements z_(k). This delay appears in FIG. 12 as an e^(−θs) factor in the transfer function K_(k+1), for any 1≤k≤n−1.

Having a delay e^(−θs) on both u_(k) and z_(k+1) is equivalent with having an e^(−θs) delay in the model of the (k+1)-th vehicle G_(k+1), for any 1≤k≤n−1. The argument for this fact is the following controller equation for the equivalent scheme of FIG. 13:

$\begin{matrix} {\begin{bmatrix} u_{1} \\ {e^{{- \theta}\; s}\bigstar \; u_{2}} \\ {e^{{- \theta}\; s}\bigstar \; u_{3}} \\ M \\ {e^{{- \theta}\; s}\bigstar \; u_{n - 1}} \\ {e^{{- \theta}\; s}\bigstar \; u_{n}} \end{bmatrix} = {{H^{- 1}\begin{bmatrix} O & O & O & K & O & O \\ {\Phi_{2}^{- 1}\Phi_{1}e^{{- \theta}\; s}} & O & O & K & O & O \\ O & {\Phi_{3}^{- 1}\Phi_{2}e^{{- \theta}\; s}} & O & K & O & O \\ O & O & {\Phi_{4}^{- 1}\Phi_{3}e^{{- \theta}\; s}} & K & O & O \\ M & M & M & O & M & M \\ O & O & O & K & {\Phi_{n}^{- 1}\Phi_{n - 1}e^{{- \theta}\; s}} & O \end{bmatrix}} \bigstar {\quad{{\begin{bmatrix} u_{1} \\ u_{2} \\ u_{3} \\ M \\ u_{n - 1} \\ u_{n} \end{bmatrix}++}{\quad\quad}{H^{- 1}\begin{bmatrix} {K_{1}e^{{- \theta}\; s}} & O & O & K & O & O \\ O & {K_{2}e^{{- \theta}\; s}} & O & K & O & O \\ O & O & {K_{3}e^{{- \theta}\; s}} & K & O & O \\ O & O & O & O & O & O \\ M & M & M & O & M & O \\ O & O & O & K & O & {K_{n}e^{- \theta_{s}}} \end{bmatrix}}{\bigstar \begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n - 1} \\ z_{n} \end{bmatrix}}}}}} & (48) \end{matrix}$

Note that (48) results directly from the equation for the leader information controller described above by multiplying both sides to the left with the n×n diagonal TFM

{1,e^(−θs),e^(−θs),K,e^(−θs)}. It is important to observe that the controller given in (48) acts on the e^(−θs) delayed version of the platoon's plant that the controller given in (25) acts on. For the purposes of designing the sub-controller K_(k+1), the e^(−θs) time delay will be considered to be part of the G_(k+1) plant model in various embodiments. The LTI controller synthesis can be then performed by taking a conveniently chosen Pade rational approximation of e^(−θs) to be included in the expression of G_(p) . The LTI controller synthesis may be performed by taking a conveniently Pade approximation of the vehicle's latency time delay or of the maximum of the latencies of all vehicles in the platoon, to be included in the expression of G_(p) . It is a well-known fact that such an approximation will introduce additional non-minimum phase zeros in G_(p) and consequently some loss in performance. However, and this is important, the resulted controllers of FIG. 13 are leader information controllers and will therefore feature all the structural properties discussed above.

Recent CACC Design Methods

Recent methods on controller synthesis for string stability of vehicle platoons also dubbed Cooperative Adaptive Cruise Control systems, also use the wirelessly transmitted control signal of the predecessor in the string. However, the aforementioned methods attempt to compensate for the wireless communications induced delays by placing a LTI filter on the feedforward path such as to minimize a certain

_(∞) criterion. It is well known in control engineering that no causal LTI filter placed in series with the delay on the feedforward path can cancel out the effects of the time delay. As a consequence of this, it is acknowledged in recent methods for Fault Tolerance of Cooperative Vehicle Platoons Subject to Communication Delay, that such attempts to compensate the communications induced delay (with a LTI filter on the feedforward path and an

_(∞) criterion) always lead to string instability for distance based headways (constant interspacing policies) or in the absence of sufficiently large time headways. In contrast, the methods proposed here in some embodiments preserve string stability even for distance headways (constant interspacing policies) by means of the synchronization mechanism described before (instead of a LTI filter on the feedforward path).

Numerical Example

This section presents a numerical MATLAB simulation for the platoon motion with n=6 vehicles, having the transfer function

$\begin{matrix} {{{G_{k}(s)} = {\frac{s + \sigma_{k}}{m_{k}{s^{2}\left( {{\rho_{k}s} + 1} \right)}}e^{{- {({\tau + \theta})}}s}}},{k = 1},2,{K\mspace{14mu} 6.}} & (50) \end{matrix}$

where τ=0.1 sec. is the electro-hydraulic break/throttle actuator delay and θ=0.03 sec. is the wireless communications delay. For the k-th vehicle, the mass m_(k), the actuator time constant ρ_(k) and the stable zero σ_(k)>0 are given in Table II, next.

TABLE II NUMERICAL PARAMETERS FOR THE VEHICLES k 1 2 3 4 5 6 m_(k) [kg] 8 4 1 3 2 7 ρ_(k) [s] 0.1 0.2 0.05 0.1 0.1 0.3 σ_(k) 1 2 3 4 5 6

The leader information controllers for each vehicle were designed according to various embodiments described above, by taking a Pade approximation for the time delays from (50). The parameters Q_(jj), j=1, K, 6 were obtained by minimizing the practical

_(∞) criterion given in (40). The simulation results are given in FIG. 14. The simulation results illustrated for distributed leader information control for platooning in FIG. 14 include (from top left): disturbances for vehicle k/acceleration at the leader; Inter-vehicle spacing errors z(t); Position y(t) (absolute value); and Velocity v(t).

The leader's control signal u₀(t) (generated by the human driver in the leader vehicle) is given in the top left plot, along with a rectangular pulse disturbance w₄(t) at the 4-th vehicle. It can be observed that the u₀ causes nonzero inter-vehicle spacing error only at z₁, specifically the car behind the leader (vehicle with index 1) and not at all for the vehicles 2 and behind. The disturbance at the 4-th vehicle affects the inter-spacing errors z₄ and z₅ only (at vehicle 4 and its follower, vehicle 5, respectively) and not at all for vehicle 6.

Supplemental Remarks

It should be clear for all those skilled in the art of control engineering that the synchronization based control mechanism described before allows implementations for LTI systems with discrete time. Such implementations may be realized using digital to analog and/or analog to digital converters, zero order hold methods or similar or equivalent methods and represent different embodiments of the continuous time systems described before. Specifically, the doubly coprime factorizations (2) should be performed with respect to the stability domain of LTI discrete time which is the unit circle, the Laplace transform e^(−θs) of the continuous time delay has the discrete time correspondent given by the Z transform z-m. The H₂ and H operator norms are well defined for LTI discrete time systems and the corresponding discrete time H₂/H_(∞) model matching problems (similar to the continuous time formulation from (40)) can be solved using existing methods.

It should be clear for all those skilled in the art that the H_(∞) model matching problem (40) can be adapted as to comprise different types of cost functionals that may include supplemental closed loop transfer functions. The cost functionals may also include mixed H₂/H_(∞) cost functionals.

Peak-to-Peak Disturbance Attenuation—Homogeneous Strings

Denote with

^(m×n), the set of all m rows times n columns matrices with real entries. The following LTI discrete time, state space equations can be used to describe the dynamics of the k-th vehicle relating the controls u_(k)[t] of the vehicle to its position y_(k)[t] on the roadway, where 0≤k≤n, and the index “0” reserved for the leading vehicle (first one in the string)

x _(k)[t+1]=Ax _(k)[t]+B(u _(k)[t]+w _(k)[t]);x _(k)[0]=x _(k) ⁰∈i ¹  (51a)

y _(k)[t]=Cx _(k)[t]  (51b)

where A∈i ^(1×1), B∈i ^(1×1), C∈i ^(1×1), w_(k) are the unknown bounded disturbances. The LTI discrete time input-output equation for the k-th vehicle is given by

y _(k) =G _(p) (z)★(u _(k) +w _(k))  (52)

where * is the discrete time linear convolution. It is also assumed all vehicles have identical dynamical models given by the transfer function G_(p) (z). The actuating time delays, the communications induced time delays and the time delays produced by the synchronization mechanism for each vehicle may be included in the dynamical model of G_(p)(z).

Using the following notation for the block-diagonal matrices: A

D{A, A, . . . A}∈i ^(n1×n1), B

D{B, B . . . B}∈i^(n1×n) and C

D{C, C . . . C}∈i ^(n×n1) and let Γ₁∈i ^(n×n) be the following string formation “coupling” matrix, with V, representing the first vector of the Euclidian basis in i ^(n)

$\begin{matrix} {{\Gamma_{1}\overset{def}{=}\begin{bmatrix} {- 1} & 0 & K & 0 & 0 \\ 1 & {- 1} & K & 0 & 0 \\ M & O & O & M & M \\ 0 & 0 & O & {- 1} & 0 \\ 0 & 0 & K & 1 & {- 1} \end{bmatrix}},{V_{1}\overset{def}{=}{\begin{bmatrix} 1 \\ 0 \\ M \\ 0 \\ 0 \end{bmatrix}.}}} & (53) \end{matrix}$

Next the vectors of the relative states Δx are defined; the interspacing errors z (with respect to the predecessor in the string) and the vector of the relative controls Δu, respectively

$\begin{matrix} {{{{{{\begin{bmatrix} {\Delta \; x_{1}} \\ {\Delta \; x_{2}} \\ M \\ {\Delta \; x_{n}} \end{bmatrix}\overset{def}{=}\begin{bmatrix} \left( {x_{0} - x_{1}} \right) \\ \left( {x_{1} - x_{2}} \right) \\ M \\ \left( {x_{N - 1} - x_{N}} \right) \end{bmatrix}};}\begin{bmatrix} z_{1} \\ z_{2} \\ M \\ z_{N} \end{bmatrix}}\overset{def}{=}\begin{bmatrix} \left( {y_{0} - y_{1}} \right) \\ \left( {y_{1} - y_{2}} \right) \\ M \\ \left( {y_{N - 1} - y_{N}} \right) \end{bmatrix}};}{{\Delta \; u}\overset{def}{=}{\begin{bmatrix} {- u_{1}} \\ \left( {u_{1} - u_{2}} \right) \\ M \\ \left( {u_{N - 1} - u_{N}} \right) \end{bmatrix}.}}} & (54) \end{matrix}$

The time evolution of the regulated measures are of interest, which in the formation control problem is the interspacing error vector z, therefore by subtracting the equation (51) for the k-th agent from the equation of the (k−1)-th agent in order to get the following state equations of the relative states

Δx _(k)[t+1]=AΔx _(k)[t]+B(u _(k−1)[t]−u _(k)[t])+B(w _(k−1)[t]−w[t])  (55a)

z _(k)[t]=CΔx _(k)[t]+Ev[t]  (55b)

where v is the bounded measurement noise of the interspacing distance. Writing (55) in an aggregated form, for the entire formation using the notation from (54) yields

Δx[t+1]=AΔx[t]+BΔu[t]+[BV ₁ BΓ ₁][_(w[t]) ^((w) ⁰ ^([t]+u) ⁰ ^([t]))]  (56a)

z[t]=CΔx[t]+Ev[t]  (56b)

where in (56) the control u₀ of the leading vehicle is considered to be included in the disturbance w₀, since they represent reference signals for the entire string. Controllers of the form

Δu=−K _(d) z.  (57)

can be constructed. A particular structure of the controller (57) that achieves an optimal disturbance rejection level μ* in presence of bounded disturbances and bounded measurement noise, namely when ∥w₀[t]∥_(∞)≤1,∥w[t]∥_(∞)≤1 and ∥v[t]∥_(∞)≤1 is desired. In other words, for zero error initial conditions z[0]=0 the closed-loop system errors must satisfy:

∥z[t]∥≤μ*,∀t.  (58)

The resolution of the following convex (linear) programming problem leads to the optimal rejection level and to the distributed linear control law:

$\begin{matrix} {{\mu^{*} = {\underset{K_{d},S,\mu}{\min \;}\mu}}{subject}\mspace{14mu} {to}\left\{ {\begin{matrix} {{\mu > 0},{S \geq 0}} \\ {{SC} = {C\left( {A - {BK}_{d}} \right)}} \\ {{- {\mu 1}} \leq {{S\; 1} + {{CB}\; \Gamma {\overset{\_}{w}}^{i}} + {{CBV}_{1}{\overset{\_}{w}}_{0}^{j}} + {E{\overset{\_}{v}}^{k}}} \leq {\mu 1}} \end{matrix}.} \right.} & (59) \end{matrix}$

The matrix S is square and n times n, the inequality S≥0 is interpreted element-wise and the vectors w ^(i), w ₀ ^(j) and v ^(k) are the extreme realizations of the respective disturbances noises while 1 is the constant vector with all entries equal to 1. The optimization problem is linear with respect to the gain matrix K_(d) and the rejection factor μ. Efficient LP solvers can be used for large instances of this optimization-based control design. In the present formulation, the distributed linear feedback ensures an optimal rejection by including the structural constraints at the design stage.

The linear program in (59) whose size depends on the number of vehicles in the string can be solved onboard each vehicle in order to produce the gain K_(d). The linear program in (59) may be decomposed in its block diagonal components and solved in a distributed manner onboard each vehicle in order to produce the local gain. The regularization information for the entire string for the level of disturbances and noises may be made available to each vehicle through communications protocols. It should be clear to all those skilled in the art that various equivalent forms of (59), such as to attain optimal or suboptimal performance can be formulated without altering its structure and such as to incorporate certain rank conditions on the state space realization matrices.

Heterogeneous Platoons with Time Headways

Let us assume that the LTI discrete time input-output equation for the k-th vehicle strictly proper transfer function from its control signal u_(k)[t] to its position on the road y_(k)[t] is given by

y _(k)=Φ_(k)(z)G _(p) (z)★(u _(k) +w _(k))  (60)

where ★ is the discrete time linear convolution. The actuating time delays, the communications induced time delays and the time delays produced by the synchronization mechanism for each vehicle may be included in the dynamical model.

Consider similarly to (11) the discrete time inter-vehicle spacing errors z_(k)

y_(k−1)H★y_(k) for the k-th vehicle

z _(k)[t]

y _(k−1)[t]−(y _(k)[t]+h(y _(k)[t]−y _(k)[t−1])), for 1≤k≤n.  (61)

or equivalently

z _(k) =G _(k−1)★(u _(k−1) +w _(k−1))−HG _(k)★(u _(k) +w _(k)),1≤k≤n,  (62)

where the Z transform of the discrete time headway H(z) is defined as

H(z)

1+h(1−z ⁻¹),h>0  (63)

or equivalently

$\begin{matrix} {{{H(z)} = \frac{{\left( {1 + h} \right)z} - h}{z}},{h > 0}} & (64) \end{matrix}$

having one pole at z=0 and one Smith zero at z=h/(1+h). Since G_(k−1)=G_(p) Φ_(k−1) and G_(k)=G_(p) Φ_(k), (62) can be rewritten as

z _(k) =G _(p) Φ_(k)★(Φ_(k) ¹Φ_(k−1) ★u _(k−1) −H★u _(k))+G _(p) Φ_(k−1) ★w _(k−1) −HG _(p) Φ_(k) ★w _(k)  (65)

and considering control laws of the type

Φ_(k) ⁻¹Φ_(k−1) ★u _(k−1) −H★u _(k) =−K _(k) ★z _(k) with 2≤k≤n,  (66)

resulting therefore in the control architectures from FIG. 10 and FIG. 11. The discrete time equivalent of equation (16) of the platoon's plant reads:

$\begin{matrix} {\begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n} \end{bmatrix} = {{\begin{bmatrix} 1 \\ O \\ O \\ M \\ O \end{bmatrix}\; \Phi_{0}{\bigstar \left( {u_{0} + w_{0}} \right)}} + {\quad{\begin{bmatrix} {{- H}\Phi_{1}} & O & O & K & O \\ {\; \Phi_{1}} & {{- H}\; \Phi_{2}} & O & K & O \\ O & {\; \Phi_{2}} & {{- H}\; \Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {{- H}\; \Phi_{n}} \end{bmatrix}{{\bigstar \begin{bmatrix} \left( {u_{1} + w_{1}} \right) \\ \left( {u_{2} + w_{2}} \right) \\ \left( {u_{3} + w_{3}} \right) \\ M \\ \left( {u_{n} + w_{n}} \right) \end{bmatrix}}.}}}}} & (67) \end{matrix}$

In view of (66) the aggregated controller equations read:

$\begin{matrix} {\begin{bmatrix} {{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{1}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{2}} + {\Phi_{2}^{- 1}\Phi_{1}\bigstar \; u_{1}}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{3}} + {\Phi_{3}^{- 1}\Phi_{2}\bigstar \; u_{2}}} \\ M \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{n - 1}} + {\Phi_{n - 1}^{- 1}\Phi_{n - 2}\bigstar \; u_{n - 2}}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{n}} + {\Phi_{n}^{- 1}\Phi_{n - 1}\bigstar \; u_{n - 1}}} \end{bmatrix} = {\quad{- {\quad{\begin{bmatrix} K_{1} & O & O & K & O & O \\ O & K_{2} & O & K & O & O \\ O & O & K_{3} & K & O & O \\ O & O & O & O & O & O \\ M & M & M & O & M & O \\ O & O & O & K & O & K_{n} \end{bmatrix} \bigstar {\quad\begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n - 1} \\ z_{n} \end{bmatrix}}}}}}} & (68) \end{matrix}$

Defining the relative controls vector Δu[t] to be given by

$\begin{matrix} {{\Delta \; {u\lbrack t\rbrack}}\overset{def}{=}\begin{bmatrix} {{- H}\mspace{11mu} \bigstar \mspace{11mu} {u_{1}\lbrack t\rbrack}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} {u_{2}\lbrack t\rbrack}} + {\Phi_{2}^{- 1}\Phi_{1}\bigstar \mspace{11mu} {u_{1}\lbrack t\rbrack}}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} {u_{3}\lbrack t\rbrack}} + {\Phi_{3}^{- 1}\Phi_{2}\bigstar \mspace{11mu} {u_{2}\lbrack t\rbrack}}} \\ M \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} {u_{n - 1}\lbrack t\rbrack}} + {\Phi_{n - 1}^{- 1}\Phi_{n - 2}{{\bigstar u}_{n - 2}\lbrack t\rbrack}}} \\ {{H\mspace{11mu} \bigstar \mspace{11mu} {u_{n}\lbrack t\rbrack}} - {\Phi_{n}^{- 1}\Phi_{n - 1}\bigstar \mspace{11mu} {u_{n - 1}\lbrack t\rbrack}}} \end{bmatrix}} & (69) \end{matrix}$

In view of (68), (67) can be rewritten as the following completely decoupled system

$\begin{matrix} {\begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n} \end{bmatrix} = {\begin{bmatrix} {G_{}\Phi_{1}} & O & O & K & O \\ O & {G_{}\Phi_{2}} & O & K & O \\ O & O & {G_{}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {G_{}\Phi_{N}} \end{bmatrix}\bigstar {\quad{\begin{bmatrix} {{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{1}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{2}} + {\Phi_{2}^{- 1}\Phi_{1}\bigstar \mspace{11mu} u_{1}}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{3}} + {\Phi_{3}^{- 1}\Phi_{2}\bigstar \mspace{11mu} u_{2}}} \\ M \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{n - 1}} + {\Phi_{n - 1}^{- 1}\Phi_{n - 2}\bigstar \mspace{11mu} u_{n - 2}}} \\ {{{- H}\; \bigstar \mspace{11mu} u_{n}} + {\Phi_{n}^{- 1}\Phi_{n - 1}\bigstar \mspace{11mu} u_{n - 1}}} \end{bmatrix} + {\begin{bmatrix} 1 \\ O \\ O \\ M \\ O \end{bmatrix}G_{}\Phi_{0}{\bigstar \left( {u_{0} + w_{0}} \right)}} + {\quad\left\lbrack {\begin{matrix} {{- {HG}_{}}\Phi_{1}} & O & O & K & O \\ {G_{}\Phi_{1}} & {{- {HG}_{}}\Phi_{2}} & O & K & O \\ O & {G_{}\; \Phi_{2}} & {{- {HG}_{}}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {{- {HG}_{}}\Phi_{n}} \end{matrix}\left. \quad \right\rbrack {{\bigstar \begin{bmatrix} w_{1} \\ w_{2} \\ w_{3} \\ M \\ w_{n} \end{bmatrix}}.}} \right.}}}}} & (70) \end{matrix}$

The transformation for the relative controls vector is given by:

$\begin{bmatrix} {{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{1}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{2}} + {\Phi_{2}^{- 1}\Phi_{1}\bigstar \mspace{11mu} u_{1}}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{3}} + {\Phi_{3}^{- 1}\Phi_{2}\bigstar \mspace{11mu} u_{2}}} \\ M \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{n - 1}} + {\Phi_{n - 1}^{- 1}\Phi_{n - 2}\; \bigstar \mspace{11mu} u_{n - 2}}} \\ {{{- H}\mspace{11mu} \bigstar \mspace{11mu} u_{n}} + {\Phi_{n}^{- 1}\Phi_{n - 1}\bigstar \mspace{11mu} u_{n - 1}}} \end{bmatrix} = {\left\lbrack \begin{matrix} {- H} & O & O & K & O & O \\ {\Phi_{2}^{- 1}\Phi_{1}} & {- H} & O & K & O & O \\ O & {\Phi_{3}^{- 1}\Phi_{2}} & {- H} & K & O & O \\ M & M & M & \; & M & M \\ O & O & O & K & {- H} & O \\ O & O & O & K & {\Phi_{n}^{- 1}\Phi_{n - 1}} & H \end{matrix} \right\rbrack  {\bigstar \begin{bmatrix} u_{1} \\ u_{2} \\ u_{3} \\ M \\ u_{n - 1} \\ u_{n} \end{bmatrix}}}$

where Γ₂(z) denotes the following transfer function matrix

$\begin{matrix} {{\Gamma_{2}(z)}\overset{def}{=}\begin{bmatrix} {- H} & O & O & K & O & O & O \\ {\Phi_{2}^{- 1}\Phi_{1}} & {- H} & O & K & O & O & O \\ O & {\Phi_{3}^{- 1}\Phi_{2}} & {- H} & K & O & O & O \\ M & M & M & \; & M & M & M \\ O & O & O & K & {- H} & O & O \\ O & O & O & K & {\Phi_{n - 1}^{- 1}\Phi_{n - 2}} & {- H} & O \\ O & O & O & K & O & {\Phi_{n}^{- 1}\Phi_{n - 1}} & {- H} \end{bmatrix}} & (71) \end{matrix}$

while noting that

$\begin{matrix} {{\Gamma_{2}(z)}^{- 1} = {- \left\lbrack \begin{matrix} H^{- 1} & O & O & K & O & O & O \\ {H^{- 2}\Phi_{2}^{- 1}\Phi_{1}} & H^{- 1} & O & K & O & O & O \\ {H^{- 3}\Phi_{3}^{- 1}\Phi_{1}} & {H^{- 2}\Phi_{3}^{- 1}\Phi_{2}} & H^{- 1} & K & O & O & O \\ M & M & M & \; & M & M & M \\ {H^{{- n} + 2}\Phi_{n - 2}^{- 1}\Phi_{1}} & {H^{{- n} + 3}\Phi_{n - 2}^{- 1}\Phi_{2}} & {H^{{- n} + 4}\Phi_{n - 2}^{- 1}\Phi_{3}} & K & H^{- 1} & O & O \\ {H^{{- n} + 1}\Phi_{n - 1}^{- 1}\Phi_{1}} & {H^{{- n} + 2}\Phi_{n - 1}^{- 1}\Phi_{2}} & {H^{{- n} + 3}\Phi_{n - 1}^{- 1}\Phi_{3}} & K & {H^{- 2}\Phi_{n - 1}^{- 1}\Phi_{n - 2}} & H^{- 1} & O \\ {H^{- n}\Phi_{n}^{- 1}\Phi_{1}} & {H^{{- n} + 1}\Phi_{n}^{- 1}\Phi_{2}} & {H^{{- n} + 2}\Phi_{n}^{- 1}\Phi_{3}} & K & {H^{- 3}\Phi_{n}^{- 1}\Phi_{n - 2}} & {H^{- 2}\Phi_{n}^{- 1}\Phi_{n - 1}} & H^{- 1} \end{matrix} \right\rbrack}} & (71) \end{matrix}$

It also holds that for the platoon's plant

$\begin{matrix} {G\overset{def}{=}{\begin{bmatrix} {{- {HG}_{}}\Phi_{1}} & O & O & K & O \\ {G_{}\Phi_{1}} & {{- {HG}_{}}\Phi_{2}} & O & K & O \\ O & {G_{}\Phi_{2}} & {{- {HG}_{}}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {{- {HG}_{}}\Phi_{n}} \end{bmatrix} = =}} & (72) \\ {\begin{bmatrix} {G_{}\Phi_{1}} & O & O & K & O \\ O & {G_{}\Phi_{2}} & O & K & O \\ O & O & {G_{}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {G_{}\Phi_{n}} \end{bmatrix}{\quad\begin{bmatrix} {- H} & O & O & K & O & O & O \\ {\Phi_{2}^{- 1}\Phi_{1}} & {- H} & O & K & O & O & O \\ O & {\Phi_{3}^{- 1}\Phi_{2}} & {- H} & K & O & O & O \\ M & M & M & \; & M & M & M \\ O & O & O & K & {- H} & O & O \\ O & O & O & K & {\Phi_{n - 1}^{- 1}\Phi_{n - 2}} & {- H} & O \\ O & O & O & K & O & {\Phi_{n}^{- 1}\Phi_{n - 1}} & {- H} \end{bmatrix}}} & (73) \end{matrix}$

The equation (70) becomes

$\begin{matrix} {\begin{bmatrix} z_{1} \\ z_{2} \\ z_{3} \\ M \\ z_{n} \end{bmatrix} = {{\begin{bmatrix} {G_{}\Phi_{1}} & O & O & K & O \\ O & {G_{}\Phi_{2}} & O & K & O \\ O & O & {G_{}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {G_{}\Phi_{N}} \end{bmatrix}\mspace{11mu} \bigstar \mspace{11mu} \Delta \; {u\lbrack t\rbrack}} + {\begin{bmatrix} 1 \\ O \\ O \\ M \\ O \end{bmatrix}G_{} \Phi_{0} \bigstar  {\quad{\left( {u_{0} + w_{0}} \right) + {\quad {\begin{bmatrix} {G_{}\Phi_{1}} & O & O & K & O \\ O & {G_{}\Phi_{2}} & O & K & O \\ O & O & {G_{}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {G_{}\Phi_{n}} \end{bmatrix}{\Gamma_{2}(z)}{{\bigstar \begin{bmatrix} w_{1} \\ w_{2} \\ w_{3} \\ M \\ w_{n} \end{bmatrix}}.}}}}}}}} & (74) \end{matrix}$

Let (A,B,C) be a state space realization of the strictly proper diagonal transfer function matrix

$\quad\begin{bmatrix} {G_{}\Phi_{1}} & O & O & K & O \\ O & {G_{}\Phi_{2}} & O & K & O \\ O & O & {G_{}\Phi_{3}} & K & O \\ M & M & M & \; & M \\ O & O & O & K & {G_{}\Phi_{n}} \end{bmatrix}$

with each of the matrices (A,B,C) being block-diagonal. The state equations for the entire string read

Δx[t+1]=AΔx[t]+BΔu[t]+B[V ₁Φ₁ ⁻¹(z)Φ₀Γ₂(z)]★[_(w[t]) ^((u) ⁰ ^([t]+w) ⁰ ^([t]))]  (75a)

z[t]=CΔx[t]+Ev[t]  (75b)

where in (75) the control u₀[t] of the leading vehicle is considered to be included in the disturbance w₀[t], since they represent reference signals for the entire string, while v is the bounded measurement noise for the inter-spacing distances. Given the extreme realizations of the (u₀[t]+w₀[t]),w(t) disturbances, the extreme realizations of the filtered disturbances

[V ₁(Φ₁ ⁻¹Φ₀(z)Γ₂(z)]★[_(w[t]) ^((u) ⁰ ^([t]+w) ⁰ ^([t]))]  (76)

may be computed using existing methods from theory and computation of disturbance invariant sets for discrete time linear systems. Controllers of the form

Δu=−K _(d) z.  (77)

are desired. A particular structure of the controller (77) that achieves an optimal disturbance rejection level μ* in presence of bounded disturbances and bounded measurement noise, namely when ∥w₀[t]∥_(∞)≤1,∥w[t]∥_(∞)≤1 and ∥v[t]∥_(∞)≤1. In other words, for zero error initial conditions z[0]=0 the closed-loop system errors must satisfy:

∥z[t]∥≤μ*,∀t.  (78)

The extreme realizations of the filtered disturbances may be used to write the following linear program for the synthesis of the distributed controller. The resolution of the following convex (linear) programming problem leads to the optimal rejection level and to the distributed linear control law:

$\begin{matrix} {{\mu^{*} = {\min\limits_{{K_{d}S},\mu}\mspace{11mu} \mu}}{{subject}\mspace{14mu} {to}\mspace{14mu} \left\{ {\begin{matrix} {{\mu > 0},{S \geq 0}} \\ {{{SC} = {C\left( {A - {BK}_{d}} \right)}},} \\ {{{- \mu}\; 1} \leq {{S\; 1} + {{CB}{\overset{\_}{w}}^{i}} + {{CBV}_{1}{\overset{\_}{w}}_{0}^{j}} + {E{\overset{\_}{v}}^{k}}} \leq {\mu \; 1}} \end{matrix}.} \right.}} & (79) \end{matrix}$

The matrix S is square and n by n and the inequality S≥0 is interpreted element-wise and the vectors w ^(i), w ₀ ^(j) and v ^(k) are now the extreme realizations of the filtered disturbances (76) and of the measurement noise respectively, while 1 is the constant vector with all entries equal to 1. The optimization problem is linear with respect to the gain matrix K_(d) and the rejection factor μ. Efficient LP solvers can be used for large instances of this optimization-based control design. In the present formulation, the distributed linear feedback ensures an optimal rejection by including the structural constraints at the design stage.

Once the optimal gain K_(d) is computed by solving (79) onboard each vehicle, the control signal for the k-th vehicle can be retrieved from (66) by the following LTI filtration

u _(k)[t]=H ⁻¹Φ_(k) ⁻Φ_(k−1) ★u _(k−1)[t]+H ⁻¹ K _(k) ★z _(k)[t]  (80)

The linear program in (79) whose size depends on the number of vehicles in the string can be solved onboard each vehicle in order to produce the gain K_(d). The linear program in (79) may be decomposed in its block diagonal components and solved in a distributed manner onboard each vehicle in order to produce local gain. The regularization information for the entire string for the level of disturbances and noises may be made available to each vehicle through communications protocols. It should be clear to all those skilled in the art that various equivalent forms of (79), such as to attain optimal or suboptimal performance can be formulated without altering its structure and such as to incorporate certain rank conditions on the state space realization matrices. The linear program (79) may be solved each time the composition of the formation changes due to merging/exiting of vehicles

Alternative Method

For each agent consider the following dynamics, relating the controls u_(k)(t) of the k-th vehicle to its position Y_(k)(t) on the roadway

y _(k) ^(&) =v _(k) ,v _(k) ^(&)=ƒ(v _(k))+u _(k),  (81)

where y_(k) ^(&) is the differential with respect to the time argument of y_(k)(⋅) and v_(k)(t) is the instantaneous speed of the k-th agent. We define

z _(k)

y _(k) −y _(k−1) ,z _(k) ^(v)

v _(k) −v _(k−1),  (82)

with 1≤k≤N to be the interspacing and relative velocity error signals, respectively (with respect to the predecessor in the string). It follows that z_(k) ^(&)=z_(k) ^(v) and so the relative velocity error evolution for the k-th agent is given by

z _(k) ^(&)=ƒ(v _(k))−ƒ(v _(k−1))+u _(k) −u _(k).  (83)

The current embodiment synchronizes the trajectory of all agents with the one of the first vehicle in the string while avoiding collision and regulating the relative speed errors z_(k) ^(v) (velocity matching).

For the nonlinear control policies we look at the Artificial Potential Functions (APF) which are commonplace in nonlinear agents control. We write the following control law for the k-th vehicle (we present the delay-free situation first and account for the transmission delays in the sequel)

u _(k) =u _(k−1)−β_(k)(v _(k) −v _(k−1))−∇_(y) _(k) V _(k,k−1)(Py _(k) −y _(k−1) P _(σ))  (84)

where V_(k,k−1)(⋅) is the Artificial Potential Function and β_(k) is a proportional gain, to be designed for supplemental performance requirements. We plug (84) into (83) in order to obtain the closed-loop error dynamics

z _(k) ^(&)=ƒ(v _(k))−ƒ(v _(k−1))−β_(k) z _(k) ^(v)−∇_(y) _(k) V _(k,k−1)(Pk _(y) −y _(k−1) P _(σ)).  (85)

Under the assumption that the real function ƒ(−) is concave and differentiable and its differential ƒ′(⋅) is upper-bounded by a given constant γ, such that ƒ(v_(k))−ƒ(v_(k−1))≤γe_(k) ^(v), it follows by Gronwall's lemma that the solutions of (85) are upper-bounded by those of the following completely decoupled closed-loop error dynamics

z _(k) ^(&)=(γ−β)z _(k) ^(v)−∇_(y) _(k) V _(k,k−1)(Pz _(k) P _(σ)),  (86)

therefore rendering the velocity matching problem for the n platooning vehicles equivalent to the asymptotic stability of “0” as an equilibrium point for (86).

The following results delineate a decoupling property achieved by the closed-loop of this embodiment.

Assume the function ƒ(⋅) in (81) satisfies the standard Lipshitz-like condition (v₂−v₁)*(ƒ(v₂)−ƒ(v₁))≤αPv₂−v₁P₂ ², for any two vectors v₁, v₂. The following Lyapunov function

$\begin{matrix} {L = {{\frac{1}{2}{\sum_{k = 1}^{N}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}}} + {\frac{1}{2}{\sum_{k = 1}^{N}{z_{k}^{v\bullet}z_{k}^{v}}}}}} & (87) \\ {satisfies} & \; \\ {{\frac{d}{dt}L} = {{\sum_{k = 1}^{N}{z_{k}^{v\bullet}\left( {{f\left( v_{k} \right)} - {f\left( v_{k - 1} \right)}} \right)}} - {\sum_{k = 1}^{N}{\beta_{k}z_{k}^{v\bullet}z_{k}^{v}}}}} & (88) \end{matrix}$

and therefore (88) does not depend on the Artificial Potential Functions included in the Lyapunov function (87).

To see this, taking the differential with respect to time in (87) yields

$\begin{matrix} {{{\frac{d}{dt}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}} = {\left( {\text{?} - \text{?}} \right)^{\bullet}\left( {{\nabla_{y_{k}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}} - {\nabla_{y_{k - 1}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}}} \right)}}{\text{?}\text{indicates text missing or illegible when filed}}} & (89) \end{matrix}$

and by employing the standard property of APFs:

$\begin{matrix} {{\nabla_{y_{k}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}} = {{- {\nabla_{y_{k - 1}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}}}\mspace{14mu} {\quad{{{we}\mspace{14mu} {get}\mspace{14mu} {that}\mspace{14mu} \frac{d}{dt}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}} = {2\text{?}^{\bullet}{\nabla_{y_{k}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}}\text{?}\text{indicates text missing or illegible when filed}}}}}} & (90) \end{matrix}$

therefore from (87) it follows that

${\frac{d}{dt}L} = {{{\sum_{k = 1}^{N}{Z_{k}^{v\bullet}{\nabla_{y_{k}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}}}} + {\sum_{k = 1}^{N}{z_{k}^{v\bullet}\text{?}}}} = {{\sum_{k = 1}^{N}{z_{k}^{v\bullet}\left( {{\nabla_{y_{k}}{V_{k,{k - 1}}\left( {{Py}_{k} - {y_{k - 1}P_{\sigma}}} \right)}} + \text{?}} \right)}}\overset{(85)}{=}{{\sum_{k = 1}^{N}{z_{k}^{v\bullet}\left( {{f\left( v_{k} \right)} - {f\left( v_{k - 1} \right)} - {\beta_{k}z_{K}^{v}}} \right)}} = {{\sum_{k = 1}^{N}{z_{k}^{v\bullet}\left( {{f\left( v_{k} \right)} - {f\left( v_{k - 1} \right)}} \right)}} - {\sum_{k = 1}^{N}{\beta_{k}z_{k}^{v\bullet}z_{k}^{v}}}}}}}$ ?indicates text missing or illegible when filed

The velocity matching manifold is completely characterized by the leader dynamics i.e. (y₀(t),v₀(t)) accompanied by the zero error initial conditions z_(k) ^(v)(t)=0. Making use of (87) and (88) we conclude that the string tends to the minimum of the potential function Σ_(k=1) ^(N)V_(k,k−1)(Py_(k)−y_(k−1)P_(σ)). Since V_(k,k−1)(Py_(k)−y_(k−1)P_(σ))→∞ as Py_(k)−y_(k−1)P_(σ)→0, the controller (84) avoids vehicles collision. Since in (88) the APFs are no longer present, the only parameter to design for performance purposes in the control law (84) are the gains β_(k), with 1≤β_(k)≤N. Note that from (88) it follows that velocity matching is guaranteed as far as β_(k)>α,∀k (α being the Lipshitz constant)

The Synchronization Mechanism for Delays Compensation

The embodiments described here may be used in conjunction with the synchronization mechanism in order to compensate the communications delays, therefore inducing fixed and point-wise delays. An accurate synchronization of the onboard measurements z_(k) and z_(k) ^(v) with the predecessor's (θ ms. delayed) transmission u_(k−1) in the control law in (84) yields

u _(k)(t)=u _(k−1)(t−θ)−β_(k) e _(k) ^(v)(t−θ)−∇_(y) _(k) V _(k,k−1)(Pz _(k−1)(t−θ)P _(σ))  (91)

The closed-loop error dynamics (85) become

z _(k) ^(&)(t)=ƒ(z _(k) ^(v)(t)+v _(k−1)(t))−ƒ(v _(k−1)(t))−β_(k) z _(k) ^(v)(t−θ)−∇_(y) _(k) V _(k,k−1)(Pz _(k−1)(t−θ)P _(σ)).  (92)

In order to evaluate the effects of the communications delays on the performance of the distribute control scheme the analysis can be performed by observing the fact that if all solutions of (92) converge to a bounded forward invariant set, then the velocity matching problem for all vehicles is achieved locally if the linearization of (92) is uniformly asymptotically stable. Therefore, the effect of communication delay on the string stability can be studied in two steps. Firstly we analyze the stability of velocity matching equilibria by linearizing (92) for the entire formation, around (v*,K,v*):

$\begin{matrix} {\mspace{79mu} {{{\begin{matrix} {\text{?}(t)} \\ M \\ {\text{?}(t)} \end{matrix}} = {{\Theta {\begin{matrix} {z_{1}^{v}(t)} \\ M \\ {z_{N}^{v}(t)} \end{matrix}}} - {\begin{matrix} {\beta_{1z_{1}^{v}}\left( {t - \theta} \right)} \\ M \\ {\beta_{N}{z_{N}^{v}\left( {t - \theta} \right)}} \end{matrix}}}}\mspace{79mu} {where}\mspace{79mu} {\Theta = {\frac{\partial f}{\partial v}{\left( v^{*} \right).\text{?}}\text{indicates text missing or illegible when filed}}}}} & (93) \end{matrix}$

As a second step, we can go beyond the linearized stability analysis by using the methods for “Synchronization of delay-coupled nonlinear oscillators: An approach based on the stability analysis of synchronized equilibria”. The optimization of the β_(k) controller gains may be performed in order to achieve supplemental performance under certain assumptions on the ƒ(⋅) in (81), while accounting for closed-loop stability guaranties.

Embodiments of the present technology or any part(s) or function(s) thereof may be implemented using hardware, software, or a combination thereof, and may be implemented in one or more computer systems or other processing systems. A computer system for performing the operations of the present invention and capable of carrying out the functionality described herein can include one or more processors connected to a communications infrastructure (e.g., a communications bus, a cross-over bar, or a network). Various software embodiments are described in terms of such an exemplary computer system. After reading this description, it will become apparent to a person skilled in the relevant art(s) how to implement the invention using other computer systems and/or architectures.

The computer system can include a display interface that forwards graphics, text, and other data from the communication infrastructure (or from a frame buffer) for display on a display unit. The display interface can communicate with a browser. The computer system also includes a main memory, preferably a random access memory, and may also include a secondary memory and a database. The secondary memory may include, for example, a hard disk drive and/or a removable storage drive, representing a floppy disk drive, a magnetic tape drive, an optical disk drive, etc. The removable storage drive reads from and/or writes to a removable storage unit in a well-known manner. The removable storage unit can represent a floppy disk, magnetic tape, optical disk, etc. which is read by and written to by the removable storage drive. As will be appreciated, the removable storage unit can include a computer usable storage medium having stored therein computer software and/or data.

The computer system may also include a communications interface which allows software and data to be transferred between the computer system and external devices. The terms “computer program medium” and “computer usable medium” are used to refer generally to media such as the removable storage drive, a hard disk installed in the hard disk drive, and signals. These computer program products provide software to the computer system.

Computer programs or control logic are stored in the main memory and/or the secondary memory. Computer programs may also be received via the communications interface. Such computer programs or control logic (software), when executed, cause the computer system or its processor to perform the features and functions of the present invention, as discussed herein.

CONCLUSION

Unless the context clearly requires otherwise, throughout the description and the claims, the words “comprise,” “comprising,” and the like are to be construed in an inclusive sense, as opposed to an exclusive or exhaustive sense; that is to say, in the sense of “including, but not limited to.” As used herein, the terms “connected,” “coupled,” or any variant thereof means any connection or coupling, either direct or indirect, between two or more elements; the coupling or connection between the elements can be physical, logical, or a combination thereof. Additionally, the words “herein,” “above,” “below,” and words of similar import, when used in this application, refer to this application as a whole and not to any particular portions of this application. Where the context permits, words in the above Detailed Description using the singular or plural number may also include the plural or singular number respectively. The word “or,” in reference to a list of two or more items, covers all of the following interpretations of the word: any of the items in the list, all of the items in the list, and any combination of the items in the list.

The above Detailed Description of examples of the technology is not intended to be exhaustive or to limit the technology to the precise form disclosed above. While specific examples for the technology are described above for illustrative purposes, various equivalent modifications are possible within the scope of the technology, as those skilled in the relevant art will recognize. For example, while processes or blocks are presented in a given order, alternative implementations may perform routines having steps, or employ systems having blocks, in a different order, and some processes or blocks may be deleted, moved, added, subdivided, combined, and/or modified to provide alternative or subcombinations. Each of these processes or blocks may be implemented in a variety of different ways. Also, while processes or blocks are at times shown as being performed in series, these processes or blocks may instead be performed or implemented in parallel, or may be performed at different times. Further any specific numbers noted herein are only examples: alternative implementations may employ differing values or ranges.

The teachings of the technology provided herein can be applied to other systems, not necessarily the system described above. The elements and acts of the various examples described above can be combined to provide further implementations of the technology. Some alternative implementations of the technology may include not only additional elements to those implementations noted above, but also may include fewer elements.

These and other changes can be made to the technology in light of the above Detailed Description. While the above description describes certain examples of the technology, and describes the best mode contemplated, no matter how detailed the above appears in text, the technology can be practiced in many ways. Details of the system may vary considerably in its specific implementation, while still being encompassed by the technology disclosed herein. As noted above, particular terminology used when describing certain features or aspects of the technology should not be taken to imply that the terminology is being redefined herein to be restricted to any specific characteristics, features, or aspects of the technology with which that terminology is associated. In general, the terms used in the following claims should not be construed to limit the technology to the specific examples disclosed in the specification, unless the above Detailed Description section explicitly defines such terms. Accordingly, the actual scope of the technology encompasses not only the disclosed examples, but also all equivalent ways of practicing or implementing the technology under the claims.

To reduce the number of claims, certain aspects of the technology are presented below in certain claim forms, but the applicant contemplates the various aspects of the technology in any number of claim forms. For example, while only one aspect of the technology is recited as a computer-readable medium claim, other aspects may likewise be embodied as a computer-readable medium claim, or in other forms, such as being embodied in a means-plus-function claim. Any claims intended to be treated under 35 U.S.C. § 112(f) will begin with the words “means for”, but use of the term “for” in any other context is not intended to invoke treatment under 35 U.S.C. § 112(f). Accordingly, the applicant reserves the right to pursue additional claims after filing this application to pursue such additional claim forms, in either this application or in a continuing application. 

What is claimed is:
 1. A method for operating a vehicle within a string of platooning vehicles, the method comprising: receiving, via a wireless communications link, a control signal of a predecessor vehicle, wherein the predecessor vehicle immediately precedes the vehicle in the string of platooning vehicles, and wherein the control signal is indicative of a level of at least one of a brake and a throttle applied in the predecessor vehicle; applying a first electronic filter to successive values of the received control signal, wherein the first electronic filter is based on a dynamical model of the vehicle; generating values of a distance measurement signal based on at least two measurements of the distance between the vehicle and the predecessor vehicle, each of the at least two measurements being taken at a different moment in time; wherein the distance measurement signal is defined such as to include a constant time headway h>0 that subtracts h multiplied with the speed of the vehicle at that moment in time from the distance between the vehicle and the predecessor vehicle at the same moment in time; applying a second electronic filter to successive values of the distance measurement signal, wherein the second electronic filter is based on the dynamical model of the vehicle; and generating a control action to be implemented by a brake and throttle actuating system of the vehicle to maintain a desired distance between the vehicle and the predecessor vehicle, the generating being based on the filtered control signal and on the filtered determined distance measurement signal.
 2. The method of claim 1, characterized in that the first electronic filter is based on a dynamical model of the predecessor vehicle in a cascade connection with an inverse of the dynamical model of the vehicle.
 3. The method of claim 1, characterized in that: the first electronic filter is based on a dynamical model of the predecessor vehicle in a cascade connection with an inverse of the dynamical model of the vehicle and further in a cascade connection with the inverse of the time headway filter; and the second electronic filter is in a cascade connection with the inverse of the time headway filter, wherein the time headway filter is: H(s)=hs+1 for continuous time systems and H(z)=1+h(1−z ⁻¹) for discrete-time systems.
 4. The method of claim 3, further characterized by: determining a communications induced time delay at the vehicle as a duration in time between completion of development of the control signal in the predecessor vehicle and when the control signal is received; wherein the communications induced time delay is determined based on a time stamping protocol for the control signal of the predecessor vehicle.
 5. The method of claim 3, further characterized by: determining a communications induced time delay at the vehicle as a duration in time between completion of development of the control signal in the predecessor vehicle and when the control signal is received; wherein a delay in generating values of the distance measurement signal is set equal to the communications induced time delay at the vehicle.
 6. The method of claim 3, further characterized by: determining a communications induced time delay at the vehicle as a duration in time between completion of development of the control signal in the predecessor vehicle and when the control signal is received; wherein the second electronic filter delays each distance measurement signal value by a delay amount prior to filtering it, wherein the delay amount is equal to a worst case scenario communications induced time delay minus a delay in generating values of the distance measurement signal; and wherein the first electronic filter delays each received control signal value by a delay amount prior to filtering it, wherein the delay amount for each respective value of the control signal is equal to the worst case scenario communications induced time delay minus the determined communications induced time delay for that respective value; whereby filtering by the first electronic filter and the second electronic filter is time synchronized for values respectively received thereat.
 7. The method as in claim 3, characterized in that each successive value of the received control signal is time aligned to at least one of the successive values of the distance measurement signal so that operation of the first electronic filter and operation of the second electronic filter are synchronized when operating on, respectively, a value of the received control signal and a value of the distance measurement signal that are each generated within a time window.
 8. The method of claim 3, further characterized by: determining a communications induced time delay at the vehicle as a duration in time between completion of development of the control signal in the predecessor vehicle and when the control signal is received; wherein the second electronic filter delays each distance measurement signal value by a delay amount prior to filtering it, wherein the delay amount is equal to a maximum of all latencies of all of the vehicles in the string minus a delay in generating values of the distance measurement signal minus a time delay of the vehicle's brake and throttling actuating system, wherein a latency for a vehicle is the sum of (i) the largest value of the time delay of the vehicle's brake and throttle actuating system and (ii) a worst case scenario communications induced time delay; and wherein the first electronic filter delays each received control signal value by a delay amount prior to filtering it, wherein the delay amount for each respective value of the control signal is equal to the maximum of all latencies of all of the vehicles in the string minus the determined communications induced time delay for each respective received control signal value minus the time delay of the vehicle's brake and throttling actuating system; whereby the timing of operations of the first electronic filter and the second electronic filter on values supplied thereto are synchronized.
 9. The method of claim 3, characterized in that a value of the received control signal is arranged to be time aligned to a value of the distance measurement signal and wherein the value of the received control signal that is time aligned is supplied to the first electronic filter at the same time that the time aligned value of the distance measurement signal is supplied to the second electronic filter.
 10. The method of claim 3, characterized in that the second filter is further based on at least one of: a worst case scenario communications induced time delay and the maximum of all latencies of all vehicles in the string, wherein a latency of a vehicle is the sum of (i) the largest value of a time delay of the vehicle's brake and throttle actuating system, and (ii) a worst case scenario communications induced time delay.
 11. The method of claim 3, characterized in that, when applying the first electronic filter to the received control signal, the first electronic filter receives a control signal value, wherein when applying the second electronic filter to the distance measurement signal the second electronic filter receives a distance measurement signal value, and wherein each control signal value received by the first electronic filter and each distance measurement signal value received by the second electronic signal are arranged so that they correspond in time within a prescribed time window; whereby the first filter receives a value of the received control signal and the second filter receives a value of the distance measurement signal that correspond in time to each other.
 12. A vehicle control system for operating a vehicle within a string of platooning vehicles, comprising: a processing circuitry; and a memory, the vehicle control system being characterized by: the memory containing instructions that, when executed by the processing circuitry, configure the vehicle control system to: receive, via a wireless communications link, a control signal of a predecessor vehicle, wherein the predecessor vehicle immediately precedes the vehicle in the string of platooning vehicles, and wherein the control signal is indicative of a level of at least one of a brake and a throttle applied in the predecessor vehicle; apply a first electronic filter to successive values of the received control signal, wherein the first electronic filter is based on a dynamical model of the vehicle; generate values of a distance measurement signal based on at least two measurements of the distance between the vehicle and the predecessor vehicle, each of the at least two measurements being taken at a different moment in time; apply a second electronic filter to successive values of the distance measurement signal, wherein the second electronic filter is based on the dynamical model of the vehicle; and generate a control action to be implemented by a brake and throttle actuating system of the vehicle to maintain a desired distance between the vehicle and the predecessor vehicle, the generating being based on the filtered control signal and on the filtered determined distance measurement signal.
 13. The system of claim 12, characterized in that the dynamical model for a referent vehicle, the referent vehicle being one the vehicle and the predecessor vehicle, includes at least one of: a mass of the referent vehicle, technical specifications of the referent vehicle's drive train, and technical specifications of the referent vehicle's brake and throttle actuating system.
 14. The system of claim 13, characterized in that the dynamical model of a vehicle is determined from measurements of the vehicle's acceleration response to certain test control signals.
 15. The system of claim 12, wherein the platooning vehicles are subject to road disturbances and wherein the first and second filters of each vehicle in the string are such that a closed-loop transfer function matrix from a vector of additive road disturbances to a vector of the signal of distance measurements is lower bi-diagonal.
 16. The system of claim 12, wherein a leader vehicle within the string of platooning vehicles does not transmit its control signal to the its follower vehicle.
 17. The system of claim 12, wherein the platooning vehicles are subject to road disturbances and the second electronic filter for each of the platooning vehicles is based on extreme realizations of a filtered version of the additive road disturbances which is computed using disturbance invariant sets for discrete-time linear systems.
 18. The system of claim 12, the instructions, when executed by the processing circuitry, further configure the vehicle control system to: determine a communications induced time delay at the vehicle as a duration in time between completion of development of the control signal in the predecessor vehicle and when the control signal is received; wherein the second electronic filter delays each distance measurement signal value by a delay amount prior to filtering it; wherein the first electronic filter delays each received control signal value by a delay amount prior to filtering it wherein operation of the first electronic filter and operation of the second electronic filter are synchronized when operating on, respectively, a value of the received control signal and a value of the distance measurement signal that are each generated within a time window; and wherein the delay from the moment of completion of development of a value of the control signal in the predecessor vehicle to the moment the first electronic filter filters the received control signal value is equal for all vehicles in the string to a maximum of all latencies of all the vehicles in the string, wherein a latency for a vehicle is the sum of (i) the largest value of the time delay of the vehicle's brake and throttle actuating system and (ii) a worst case scenario communications induced time delay.
 19. The system of claim 12, wherein the second filter is based on the maximum of all latencies of all the vehicles in the string. 